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This thesis examines the use of a single, omnidirectional hydrophone as a 
receiving sensor to passively localize an acoustic beacon. The localization problem is 
presented as a constrained, nonlinear parameter estimation problem, and Lagrange 
multipliers are introduced to solve for the maximum likelihood estimate of the acoustic 
beacon's position. An iterative algorithm is developed using range difference 
measurements to solve for the maximum likelihood estimate of a stationary acoustic 
beacon's position. This algorithm is then extended to include linear, constant velocity 
motion of the acoustic beacon. Finally, design specifications for a receiver to 
implement the maximum likelihood estimation algorithms are developed. 

To test the maximum likelihood estimate algorithms, Monte Carlo simulations 
are conducted. Results from six representative scenarios are presented. Test results 
show that as the number of range differences used increases, or the distance that the 
observer travels between received beacon signals increases, the accuracy of the 
estimated position improves. Also, tests show that accuracy of the estimated beacon 
position is directly related to the accuracy in which the observer’s position is 
measured. To test the receiver’s design specifications, a prototype receiver is built 
using commonly available components. It is then shown that the prototype receiver 
meets or exceeds the design specifications. 
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Chapter I 



Introduction and Problem Statement 

1.1 Introduction 

There are many scenarios in which passive localization of an acoustic beacon is 
needed. Techniques like Target Motion Analysis and Bearings Only Ranging can 
passively estimate an acoustic beacon's position by using received bearing information. 
These techniques rely upon a multiple sensor receiving array to find the relative 
bearing between the acoustic beacon and the observer. To estimate the position of the 




Figure 1-1 
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acoustic beacon, bearing lines from several different observation points are combined 
to form a fix. See figure 1-1. 

Recent developments in passive target ranging and tracking which use arrays of 
only a few elements can also be used to passively localize an acoustic beacon [Allen 
and King 1988] [Friedlander 1987] [Moose 1987], These methods rely upon the array 
to estimate the relative bearing between the acoustic beacon and the observer as well. 
Statistical and test analyses have shown that the performance of the localization 
techniques mentioned above improves with increased distance between sensor elements 
in the receiving array [Moose 1987], This typically leads to the use of long receiving 
arrays. The use of long arrays can become a problem if the ship used to deploy the 
array is small, or if budget constraints limit the size of the array. For these cases, the 
observer can employ a technique that uses a single omnidirectional sensor to form a 
synthetic aperture array instead of a conventional receiving array to passively localize 
the acoustic beacon. 

Previous techniques to localize acoustic beacons using a single omnidirectional 
hydrophone instead of an array use a raster scanning paper recording device to 
produce a mark on recording paper whenever a beacon signal is received. The scan 
rate of the paper recorder is matched to the pulse repetition interval of the acoustic 
beacon. This synchronizes the paper recorder, so that a new line is printed for each 
pulse repetition interval. The observer can note the relative change in travel time 
between successive beacon signals by comparing the locations of the corresponding 
marks on the recording paper. If the observer and the acoustic beacon are stationary. 
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the time it takes the acoustic beacon's signal to travel between the beacon and the 
observer is constant. For this case, the trace made by the paper recorder is a vertical 
line. As the observer approaches the beacon along a linear path, the range to the 
beacon, and consequently the time that the beacon signal takes to travel to the 
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observer, decreases hyperbolically. The corresponding trace made by the paper 
recorder is also hyperbolic. The observer can use this relation to fix the acoustic 
beacon's position. To obtain a line of bearing to the acoustic beacon, the observer 
watches for the closet point of approach (CPA) to the acoustic beacon by noting the 
point where the trace produced by the paper recorder changes from negative to 
positive slope. This corresponds to the transverse axis of the hyperbolic trace and is 
the point where the range changes from decreasing to increasing. At the CPA, the 
acoustic beacon is located on a line of bearing perpendicular to the direction of the 
observer's motion. To estimate the location of the acoustic beacon, the observer must 
obtain lines of bearing from at least two different directions of motion. See figure 1-2. 
This method of passively locating acoustic beacons relies heavily upon the operator's 
skill in visually identifying the closest point of approach from the printed output of the 
paper recorder. Also, the observer is forced to travel in a straight line for a significant 
period of time until the CPA can be determined. Other factors that limit the 
usefulness of the above method are that paper recorders tend to be bulky, awkward to 
move, and require an adequate supply of expensive recording paper. 

This thesis examines the use of a single omnidirectional hydrophone in place of 
a conventional receiving array to efficiently localize an acoustic beacon using a 
nonlinear parameter estimation technique. The goal is to develop an inexpensive, 
easily deployed localization receiver that can interface to a personal computer for data 
analysis and signal processing. As a backup, this receiver must also perform the 
functions of the older paper recording system, using the personal computer as the 
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display device. 

1.2 Organization 

This thesis is organized into six chapters and three appendices: 

• Chapter I contains an introduction to the problem of passively localizing 
acoustic beacons. 

• Chapter II contains the development of a technique to localize a stationary 
acoustic beacon using a constrained Maximum Likelihood Estimator (MLE). 

• Chapter III contains an extension of the solution to the stationary acoustic 
beacon localization problem that allows for constant velocity, linear motion of 
the acoustic beacon. 

• Chapter IV contains results of Monte Carlo simulations of the localization 
algorithms developed in chapters II and III. The effects of using different 
effective sensor spacings and different numbers of experimental data points are 
explored. 

• Chapter V contains design criteria for a receiver to implement the algorithms 
developed in chapters II and III. A test receiver is designed and built based 
upon these criteria, and experiments are conducted to measure the actual 
performance of the receiver. 

• Chapter VI contains observations and concluding remarks. 

• Appendix 1 contains the schematic diagrams of the receiver designed in 
chapter V. 

• Appendix 2 lists the source code for the 68HC11 microcontroller used in the 
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receiver designed in chapter V. 

• Appendix 3 lists the source code for the Macintosh computer used for data 
analysis and signal processing. 
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Chapter II 



Stationary Acoustic Beacon 

2.1 Introduction 

When the acoustic beacon is stationary, we are interested in locating the 
acoustic beacon to within a certain error bound as efficiently as possible. To 
accomplish this we treat the acoustic beacon's location as an unknown parameter 
vector, and formulate the localization problem as a constrained multiple dimension 
parameter estimation problem. To solve the constrained parameter estimation problem, 
we first develop a structural model that relates the values of a set of available 
measurements to the unknown parameter vector. We then define a residual error 
vector as the difference between the true values and the actual values of the 
measurements. Assuming the measurement errors are normally distributed, 
independent random variables, we define the likelihood function for a particular set of 
measurements as the logarithm of the joint probability density function of the 
measurements errors, viewed as a function of the residual error vectors. Next, we 
form a set of equality constraints by evaluating the structural model at the true values 
of the measurements, and the true value of the parameter vector 0. To find the 
maximum likelihood estimate (MLE) of the unknown parameter vector, we introduce a 
vector of Lagrange multipliers, and then define a Lagrangian function as the 
combination of the likelihood function and the sum of the equality constraints, 
weighted by the Lagrange multipliers. The maximum likelihood estimate is then 
found by determining the stationary point of the Lagrangian function. 
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2.2 Problem Geometry 

Consider the acoustic beacon to be at a fixed latitude, longitude, and depth. 
Since we are only concerned with locating the acoustic beacon in a small region of the 
ocean, we approximate the earth as being flat in the region around the beacon's 
position and use a Cartesian coordinate system to describe the location of the acoustic 
beacon. The use of a Cartesian coordinate system does not contribute any significant 
errors as long as we correct for distortions due to the projection of the acoustic 
beacon's global coordinates onto the local Cartesian coordinate system. We define a 
parameter vector 0 as: 

0 = [ x T y T z T ] T ( 2_I ) 

where x T represents the east-west position of the acoustic beacon, y T represents the 
north-south position of the acoustic beacon, and Zj represents the depth of the acoustic 
beacon in meters relative to the center of the local Cartesian coordinate system. To 
correct for the distortions caused by projecting the acoustic beacon's global coordinates 
onto the local Cartesian coordinate system, we introduce a correction factor that is 
proportional to the cosine of the latitude. We then relate 0 to the acoustic beacon's 
global position by: 
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where x R and y R define an arbitrary reference point on the surface of the ocean which 
defines the origin of the local Cartesian coordinate system. In equation (2-2) we 
assume that the acoustic beacon's latitude and longitude are given in degrees. 

Similarly, we consider an observer on a receiving ship in the general location 
of the acoustic beacon. We define a measurement vector m M as: 

% = t ^ 3V f (2 ' 3) 

where x p and y M are the receiving ship's coordinates on the same local Cartesian 
coordinate system defined for the acoustic beacon, and t M is the time that the observer’s 
position x H , y M was obtained. We use the same relation described in equation (2-2) to 
convert the receiving ship's global coordinates to local Cartesian coordinates. The 
measurement vector m M is then given by: 



degrees longitude • ^ m . ^ (degrees latitude)- x R 



m , = 



1 ° 



degrees latitude 



1 Nm 

60 Nm . 1853.2 m 
\° 1 Nm 



y R 



ii J 



( 2 - 4 ) 



Again, we assume that the receiving ship's latitude and longitude are given in degrees. 
Figure 2-1 summarizes the problem geometry. 

Now let us assume that the acoustic beacon transmits a signal at a regular 
interval, and that at time t M the observer receives one of the signals from the acoustic 
beacon. The time t M can be related to the time that the signal took to reach the 
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observer by: 



t =T„ + i"T +T (2-5) 

Here T R represents the acoustic travel time of the signal, T 0 is the time that the 
acoustic beacon transmitted the first signal, i is the number of pulse repetition intervals 
between when the first signal was transmitted and when the current signal was 
transmitted, and T p represents the pulse repetition interval. The product /• T p represents 
the time after T 0 that the acoustic beacon transmitted the current received signal. It is 
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assumed that the observer knows the pulse repetition interval of the acoustic beacon. 
The observer can therefore remove the dependance upon /T p by counting the number 
of signals received (/'), then subtracting /T p from equation (2-5). This synchronizes 
the observer's receiver with the pulse repetition interval of the acoustic beacon. We 
define the synchronized time of receipt as the time of receipt t p corrected to eliminate 
the pulse repetition interval of the acoustic beacon as: 



t = t -i'T = T n + T 

*s|i V p R o 



(2-6) 



and subsequently redefine the measurement vector m as: 



% = [ 3V V 



(2-7) 



The difficulty in passively ranging an acoustic beacon arises because the 
observer does not know T 0 , the time the acoustic beacon started to transmit. In active 
ranging systems, the observer can measure T R directly by transmitting a signal at a 
known time T 0 , and measuring the time that the corresponding reflected signal from a 
target is received. In passive ranging systems, the observer does not know when the 
beacon signal was transmitted and therefore the observer has no time reference T 0 . 
Consequently the observer has no way to directly calculate T R . In order to passively 
range a target, the observer must eliminate the dependence on the absolute time 
reference T 0 . 

2.3 Structural Model 

In order to proceed, we must develop a model which relates the measurement 
vector m p , and the unknown parameter vector 0. We define a function f(m M , 0) 
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which relates the distance between the acoustic beacon's position 0 and the receiving 
ship's position x M , y M to the synchronized time of receipt t S(1 as: 



/(»v 0) s J(Xv-x T ¥ + (yp-y T ¥+z} -T(C, t Sil ) (2 ‘ 8) 

where x(C, t Sfl ) is a function that relates the speed of sound in seawater to the 
measured time of receipt, synchronized to the pulse repetition interval of the acoustic 
beacon. It is assumed that the receiving ship is on the surface of the ocean, or 
equivalently z p is zero. Using a homogeneous ocean model and a direct path 
propagation mode for simplicity, we can define x(C, t Sfl ) from equation (2-6) as: 

*(C, < s „) - C-r, - c-t, t - C T c (2-9) 

Substituting equation (2-9) into equation (2-8) yields: 

/(<v e > = 'l(* r -*T'?+<.y r -yTf*zi-(c-< st -c- T o'> (2 ' 10) 

It is apparent from equation (2-10) that we can not eliminate the dependence 
upon T 0 with only one received signal from the acoustic beacon. One way around this 
problem is to compare the time of receipt and positions from two separate received 
signals. This is commonly referred to as range difference, or time difference ranging. 
We define a new function g(m p m 2 , 0) as: 

g(m lt m 2 , 0) =/(»!,, 0) -f(m 2 , 0) (2-H) 

Substituting equation (2-10) into equation (2-11) with m, for the first received signal 
and m 2 for the second received signal we have: 
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g ( m v m 2 , 0 ) = y (^ 1 - A ; r ) 2 + ( y 1 ->' 7 .) 2 + 4 +... 



“V (*2 _ *r) 2 + (^ 2 “^r^ 2 + z r + - 



(2-12) 




The first two terms of the function g(m„ m 2 , 0) represent the slant range between the 
acoustic beacon and the receiving ship at the two separate times that a beacon signal is 
received. By subtracting one range from the other, we are left with the distance that 
the observer moved radially, relative to the beacon, between the times t s) and t s2 . This 
is known as the range difference between the two points given by m, and m 2 . The last 
term of the function g(m,, m 2 , 0) represent the range difference between points m, 
and m 2 calculated from the time difference. From the last term of g(m,, m 2 , 0) we see 
that the dependence upon T 0 is eliminated, and we are left with a model that relies on 
measuring the time of receipt, synchronized to the pulse repetition interval of the 
acoustic beacon, and the location of the receiving ship at the time of receipt. 

To simplify notation, we define an experiment to be the augmentation of two 
measurement vectors m, and m 2 , and use the notation: 



We then redefine the equation (2-12) as a scaler valued function of the experiment 
vector w M and the acoustic beacon location vector 0: 



m 



(2-13) 



w, 



-[*1 * hi *2 ?2 hi f 



s(>v 0 ) = g(m x , m 2 , 0 ) 



(2-14) 
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We denote the function g(w M , 0) as the structural model of the parameter estimation 
problem. Ideally, if the measurements have no errors and x(C, t J(l ) is the correct 
propagation model, g(w M , 0) equals zero at the true value of the parameter vector 0. 
The estimation problem is then to determine the value of the parameter vector 0 that 
minimizes the value of the structural model given experiment vectors which contain 
errors. 

2.4 Measurement Errors 

The structural model describes the ideal situation - perfect measurements, free 
from any errors. In reality both the synchronized time of receipt t SM and the positions 
x M , y p have errors associated with the measurement process. We can define the actual 
measurements as the sum of the true value and a random error component: 



V*i 



w = w + w = 

[1 [I [I 



hi + hi 



x 2 +x 2 



(2-15) 



hi + hi 

where x M , y M , t SM , and w M represent the true values of the measurements, and x M , y M , 

T S(1 , and w M represent the random errors associated with the measurement process. 

With the assumption of a homogeneous, direct path propagation mode, and 
since the time of receipt will be determined by looking at the output of a simple 
digital peak detector, the errors in measuring t SH arise mainly from the sampling of the 
received signal. Because we use a simple peak detector to measure the time of 
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receipt, we can only estimate the true time of receipt to within one sampling interval - 
if we sample the received signal every millisecond, then we can only know the time of 
receipt to within 1 millisecond. This quantization of the time base causes the 
measurement errors to have a uniform distribution centered around the true value t S(J 
with a variance given by: 





( 2 - 16 ) 



where T s is the sampling interval in seconds. For the sake of computational efficiency 
and mathematical tractability, we would like to model the measurement errors of t SM as 
zero mean, normally distributed random variables. If we consider that the structural 
model is not exact (a far more complex function x(C, t Sfl ) is needed to have an exact 
structural model), and that there will be errors due to factors such as dispersion and 
multipath interference, we can lump the modeling errors of x(C, t $(l ) together with the 
quantization errors in the time t SM . Although not strictly rigorous, this allows us to 
simplify the development of the solution to the localization problem by assuming the 
measurement errors of t S(J are zero mean, normally distributed random variables, with a 
variance approximated by c, M 2 . Also, since the measurement of the time of receipt of 
one signal is not effected by the measurement of any other time of receipt, we can 
take the errors in measuring t S(1 as independent between t sl and t s2 , and also 
independent between experiments w M . 

Errors in measuring the ship's position at the time of receipt of the beacon 
signal are due to the accuracy of the system used to obtain the ship’s position. To 
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obtain the ship’s location, a Global Positioning System (GPS) receiver will be used. 
Other navigation systems such as Loran, Omega, or even Inertial Navigation systems 
could be used, however the price and accuracy of the GPS system make it the natural 
choice. Currently, inexpensive commercial C/A code GPS receivers are available with 
published errors on the order of 25 meters rms in latitude and longitude. The more 
accurate Differential GPS and P code receivers are not readily available at this time. 
We will assume that the errors of the GPS positional data are normally distributed, and 
independent in latitude and longitude. This assumption is unlikely to cause much 
harm as long as the true probability distribution of the errors have smooth tails [Bard 
1974], 

With these arguments in mind, and for the sake of computational efficiency and 
mathematical tractability, we model the measurement errors as zero mean, normally 
distributed, independent random variables. We take the covariance matrix of the 
measurement errors as: 



o 2 0 0 0 0 0 

n 

0 o v 2 0 0 0 0 

0 0 o 2 0 0 0 

0 0 0 o 2 0 0 

0 0 0 0 o 2 0 

0 0 0 0 0 o 2 

V 



(2-17) 



Where a t)J 2 is the variance given by equation (2-16), a x 2 is the variance of the GPS 
longitude error in meters, and a y 2 is the variance of the GPS latitude error in meters. 
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2.5 Parameter Estimation Solution - Maximum Likelihood Estimator 

To solve for the parameter vector 0 we would normally use a weighted least 
square approach. However, because of the nonlinearities in the structural model 
gfw^, 0), and because all of the measurements have errors, the weighted least squares 
method does not work well. To demonstrate why the normal weighted least squares 
method does not work well, we look at the contours of the % 2 merit function: 



x 2 = £ 



/ 50v_6) x2 



i=l 



(2-18) 



If the structural model is truly exact, and there are no measurement errors in w M , 
g(w (l , 0) and x 2 are equal to zero for the true value of 0. As the value of 0 in 
equation (2-18) moves farther away from the true value of 0, the yj function 
increases. Figure 2-2 shows the contours of the function for the true values of the 
measurements w p , where the acoustic beacon is located at x T = -1000, y T = 1000, and 
z t- = -1000. From Figure 2-2 we see that the contours of the % 2 merit function that 
encircle the true position of the acoustic beacon are highly eccentric. This eccentricity 
leads to large variances in the location estimate along the major axis of the ellipse. 
With errors in all of the measurements, this in turn produces errors in the parameter 
estimates that are unacceptable. 

To overcome the difficulties in solving the parameter estimation problem with a 
nonlinear structural model and errors in all of the measurements, we treat the problem 
as a constrained minimization problem. Our goal is to estimate the true values of the 
measurements w M given a set of n equality constraints which we obtain by setting the 



23 




Figure 2-2 Chi Square Contours for the Normal Weighted Least Squares Method 

structural model g(w M , 0) equal to zero at the estimated true values of the 
measurements and the estimated parameter vector 0. Because of the measurement 
errors, we must modify the structural model to indicate the dependence upon the true 
values of w p : 

S(>V 0) = ^{* x -x T f + {$ x -y T ? + zl + - 

-/(i 2 -a: r ) 2 + (y2-}'r) 2 + ^ + - ^ * 9 

-c-(t i-ti 

Next we define a residual vector as the difference between the true value and the 
observed value of the measurements: 
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( 2 - 20 ) 



MV = V w i* 

We also define a composite experiment vector W as the augmentation of n experiment 
vectors w M : 



W = 



T T 
Wj w 2 



t ir 



... .;] 



( 2 - 21 ) 



With the assumption that the measurement errors are normally distributed 
random variables, independently distributed between experiments, and with the further 
assumption that the covariance matrix is the same for each experiment, the likelihood 
function takes the form: 



log(L(«', V)) = -(n/2)log(detK)-I-£ ej V' 1 e < 2 -«> 

1 = l 

where n is the number of experiment vectors w M used in the estimation problem [Bard 
1974], The maximum likelihood estimate is found by determining the value of 0*, and 
the value of w* for each of the n experiments, which minimizes log(L) while satisfying 
the n equality constraints imposed by the structural model. The terms w* and 0* 
represent the maximum likelihood estimate of the true values of w M and 0. 

To find the maximum likelihood estimate given the n equality constraints 
imposed by the structural model, we introduce an «-dimensional vector of Lagrange 
multipliers for each experiment. We then form the Lagrangian function: 



AO*', 8, V, A,,...A„) * log ( L ( it', n)+E \ -S(>V 0) (2 ‘ 23) 

[ 1=1 
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The solution to the estimation problem will be found at a stationary point of the 
Lagrangian A(W, 9, V, A,„ X M ) [Bard 1974], 

To demonstrate the benefits of using this approach, we look at the contours of 
the Lagrangian function given by equation (2-23). Using the algorithm developed in 
section 2.6, figure 2-3 shows the contours of the Lagrangian function obtained by 
using the same experiment vectors used to generate the contours of the normal 
weighted least squares method. 




Figure 2-3 Contours of the Lagrangian Function A 

From figure 2-3 we see that the contours that surround the true position of the acoustic 
beacon are much less eccentric then the contours of the normal weighted least squares 
method. Therefore, we do not have the large variances associated with the major axis 
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of the normal weighted least squares method, and the estimate of the parameter vector 
0 will be more accurate. 

To solve the maximum likelihood estimator problem given the equality 
constraint of the structural model we use an iterative method suggested by Deming as 
described by Bard [Bard 1974], We define the parameter vector 0* as the estimate of 
the acoustic beacon's location at the ith iteration: 





V V 



(2-24) 



We also define the estimated true experiment vector at the ith iteration as: 




= [ a; V i 



s 1 





and the corresponding composite experiment vector: 



(2-25) 





(2-26) 



The vector \V* is the augmentation of the n estimated true experiment vectors w* at 
the /th iteration. We then define a composite vector valued function G(\V* , 0*) where 
the yth component of G(\V* ,0*) is the structural model evaluated at (w*. 0*): 



Gctf/, e,-) = g, = [«(*,/’ e,-) e,-) ... «(»,;, e ,-)] 1 



(2-27) 



Next we define an objective function as the weighted least squares sum of the 
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residuals given by equation (2-20). At the /th iteration the objective function is: 



® \ * £ ( V - ^ ) r V~ x ( ) (2-28) 

z n-i 



This is the same form as the last term in equation (2-22). To solve for the Maximum 
Likelihood Estimate, the objective is to find the \V* which minimizes log(L), or 
equivalently, <t>(\V* ) subject to the constraints G(\V* , 0*) = 0. We note that now the 
unknown parameters that we are estimating are the acoustic beacon's location as well 
as the true values of all the measurements. 

To develop a solution, we define the following terms: 



q , * d4>(H',')/aii' 


(2-29) 


H, ■ #4>(W‘)ldWdW 


(2-30) 


a, . dG(w;, e;vdw 


(2-31) 


b s » sg(w;, e; >/36 


(2-32) 



Next we expand the objective function in a Taylor series around the current estimate 
of W and 0. Keeping only up to the second order terms we have: 

= ® i +q T l hW + ^hW T H i bW (2-33) 

Now we expand the structural model in a Taylor series around the current estimate of 
W and 0. Keeping only the first order terms we have: 
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6,(6^, 60) = G^A^W + B.^Q 



(2-34) 



To find the maximum likelihood estimate we now want to find the 8W and 50 
that minimize O, while at the same time satisfies the structural model constraints 
G, = 0. To do this we introduce the vector of Lagrange multipliers X and look for the 
stationary point of the Lagrangian: 



A. ( 6 W, 60, X . ) = <j> 4 . ( 6 W) + Xf G; ( 2 ' 35 ) 



Forming the normal equations of the Lagrangian and using equations (2-33) and (2-34) 
we have: 



d A { . ( 6 W, 60, X. t )/d(bW) = q. t + H.bW + Aj A { = 0 ( 2 ‘ 36 ) 

aA,.(6^ 60, = G j +A j 6^+5 | .60=O ( 2 ‘ 37 ) 

aA,.(6^, 60, A,.)/ 0 (60) = A { = 0 ( 2 ‘ 38 ) 

From equation (2-36): 

bw = -H^’iq. + Ajx.) ( 2 - 39 ) 

Substituting equation (2-39) into equation (2-37) we have: 

G,-A, H?q, -A, H]'Aj X,*B, 66 - 0 < 2 - 40 > 

Solving for X t : 



X, = (A,//; 1 A 7 ,)' ■ (B, 66 q,* G ( ) 
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Now substituting equation (2-41) into equation (2-38): 

«,♦<?,) =0 < 2 '«) 

Solving for 50 we are left with: 



80 = (Bj ■ (A, H, 'a] ’y' B,)-‘ Bj fA.H^Ajy' -(A,H ]' q r G,) 



(2-43) 



We can define a new term Cj as: 



C ( ( 2 ' 44 ) 

and a term D, as: 

D. = Bj C: 1 B. t (2-45) 
Substituting equations (2-44) and (2-45) into equation (2-43) gives: 



60 = Dj Bj C- 1 • (A.H? q. % - G.) ( 2 ’ 46 ) 

Once we have calculated 50, we use equation (2-41) to calculate the 
Lagrangian multipliers which in turn are substituted into equation (2-39) to calculate 
the updates to the true measurements. Equations (2-39) and (2-46) then allow us to 
iteratively calculate the estimated beacon location and the estimated true values of the 
measurements with the recursion relations: 



ev, = e V ™ 

*v, = fry** 



(2-47) 
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All we need to start the calculations are initial values for 0* and for \V*. Since the 



measurement errors are presumably small, we can use the actual measured values W 
for the initial values of \V*. However, since we have no idea of the location of the 
acoustic beacon, the choice of an initial value for 0* is more difficult. In the absence 
of any other information, we can choose the center of the search area for the initial 
value of 0*. 

In developing the solution to the maximum likelihood estimate we made the 
assumption that the measurement errors are normally distributed and independent 
between experiments. To determine if this is valid we refer back to the source of the 
measurement errors. The measurement error T S(1 is not normally distributed. However, 
if we do not make the assumption of a normally distributed error, and stay with a 
uniform distribution of errors, we will be unable to use the maximum likelihood 
method. This is because likelihood methods use gradient techniques to maximize a 
likelihood function which is based upon the probability distribution function of the 
errors. If the underlying probability distribution function is not smooth and 
continuous, there will not be a unique maximum, and a useful estimate can not be 
found. This means if we stay with the uniform distribution we will be forced to use a 
more computationally expensive direct search of the parameter space, or minimax 
method to estimate the acoustic beacon's location. 

As a result of the uniformly distributed errors in t S(J , the solution that we obtain 
from the maximum likelihood estimator is suboptimal. There is also a chance that the 
method used to find the estimate that maximizes the likeliness function will diverge. 
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This happens when the estimate of the true value of t SM is further away from the 
actual true value of t SM then the quantization of the time base allows. To prevent the 
solution from diverging, we can place additional constraints upon the minimization of 
the objective function that confine the solution to be within a feasible region. We 
define the feasible region to be the region bounded by the inequality constraints: 



-Range^ <; x T <. Range , ^ 

* y T * Range ^ (2-48) 

-Depth ^ * z T z 0 

Where Range max defines the size of the search area that we are willing to scan, and 
Depth max is the maximum depth in the area of the search. The beacon's depth is 
bounded above by the sea surface level. If the solution to the maximum likelihood 
estimator is within the feasible region, we accept the estimate. If, however, the 
solution to the maximum likelihood estimator is outside the feasible region we must 
adjust the estimator to bring the solution inside the feasible region, or in the worst 
case, disregard the estimate. 

To maintain a feasible solution we break equation (2-47) into component parts: 



= 0 V 60 = 0\- + Pe Uq 
*’,♦ i = w\+bw= w'i + ptU# 



(2-49) 



where U 9 and are unit magnitude vectors that describe the direction of 60 and 
5\V, and p e and are the magnitudes of 50 and 5W. We assume that 60, and 
hence U e , points in the proper direction to the maximum likelihood estimator. If 
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0*+ 50 is outside the feasible region defined by equation (2-48), we find the 



maximum value of p which satisfies: 



-Range^ 

-Range^ 

Depth*** 



Range m 

< e «* + Pmax^e < Range *** 

0 



(2-50) 



Once we have found p max we replace p 0 and p w in equation (2-49) which gives the 
new update equations: 



This essentially shortens the step that we move in updating 0* and W* for the iteration. 
Notice that we do not simply replace p e and p w with p max . If we did this, 0* +I would 
be on the edge of the feasible region. With 0* +1 on the edge of the feasible region, 
p max will be zero, and 0* +1 will equal 0* for all subsequent iterations. If this happens 
we will be unable to achieve any further updates of 0* +1 and W*. It is still possible 
that, after a certain number of iterations, 0| +1 lies on the edge of the feasible region. If 
this happens we must reject the estimate and try again using a different initial value 
for 0* or more experimental data points. 

2.6 Algorithm 

Figure 2-4 at the end of this section describes the algorithm used to estimate 
the location of the acoustic beacon based on Deming's method as described by Bard. 




(2-51) 
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There is no natural way of telling whether or not progress towards the solution has 
occurred in any given iteration when we use this method [Bard 1974]. Bard suggests 
calculating the quantities: 



and: 



z o = 5>n( V’ 0 /) r V 1 Sn ( V» 

!i=l 



(2-52) 



Z 1 = E 0 i* + 60 ) rc tlj ' 1 V^i* +5 V 0 / +60 ) 

ll=l 



(2-53) 



The rational behind these quantities follows that at the true values of W and 0, 
G(W, 0) must equal zero. If Q, is a positive definite matrix, we require that: 



8 ,;, / q, e;„) s G(W', e,y <?, G(\v', e/) ( 2 - 54 ) 



This means that as \V* and 0* approach the true values of W and 0, the quantity 
G(\V*, 0*) T Q, G(\V*, 0*) must decrease. The natural choice for Q, is the inverse of 
the covariance matrix of G(\V*, 0*) [Bard 1974], With V M as the covariance matrix of 
the measurements, the covariance matrix of G(W’, 0’) is approximately: 



COV ( G ( w;, e; ) ) « £ a f: v t (2-55) 

( 1=1 

Now from equation (2-30) we have: 



H i = &${W')ldWdW 



V[ l 0 ... 0 

0 V 2 1 



0 




(2-56) 
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So we choose: 



-i 



Q r COV(G(W'fi;)Y' . 



E -(A.tfAiy-c; 

, (I'l / 



(2-57) 



It then follows that: [Bard 1974] 



0(W.;, e,Y <?, G(w;, e;> - £ e,Y c„/‘ e,') 

n=l 



(2-58) 



If Z, is less then Z 0 , we accept 89 and 8\V and continue to the next iteration. If Z, is 
greater then Z 0 , we shorten 89 and 8\V and then recalculate Z,. 

To determine when to stop the algorithm we follow the termination criterion of 
Marquardt [Bard 1974], We define a tolerance: 



e i = l<r4 ‘(KL +1 ° 3 ) (2 - 59) 

where | 9* | min is the smallest component of 9*. The term 10‘ 3 is added in case 
I Q* Lin is close to zero. For each iteration we check to see if I 89 l min is less then 
Sj. If I 89 l min is less then s ; , we terminate the algorithm. If I 89 l min is not less 
then Sj, we continue. For each iteration we calculate a new tolerance value 8,. This 
leads to a conservative termination criterion that will stop the algorithm if the 
parameter values cease changing. 

To start the algorithm we choose an initial guess of the location of the 
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acoustic beacon, 0 O *. We then use the measured values of W for the initial values of 
W*. For each experiment ji, we calculate: 



e„ = w* - w„ 


(2-60) 


t» 




% = dgpldw 


(2-61) 


= dgjdd 


(2-62) 



For the case of the stationary beacon a M is given by: 



= 



/ A ♦ * \ 

(*1 -X T ) 



\ftfi x T ) 2+ (ji ~yj ) 2+ ( z t ) 2 



(Sx-yr) 



X T yi) 2+ (Zt ) 2 

-c 



(*2~ x t ) 



/(*2 - Xt) 2 +(SI - 3^r) 2+ (*r) 2 
(Si-yr) 

/(*2 - Xrf+iSi- - yr) 2+ Ur) 2 
+ c 



(2-63) 



and b is given by: 
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Xjf+iy^- y}) 2+ (ZT? 


/ W - Xt f HS! - yr ) 2 + (Zt ) 2 


(92- yr) 




/ (*i - xt ) 2 +(y2 -yr) 2+ ( zt f 


/ (*i* - Xt ) 2 +(9i ~ y T ) 2 * (Zt ) 2 


* 


+ 


/ (i/ - Xt f +(yi -y' T f + (zi ) 2 


/ c *2 - x t ) 2+ (y 2 -yr) 2+ (Zr f 



Once we have a v and b M , we calculate: 



c = a T V a 

(1 \i |i |i 



„ ^s(V> 0 *) 2 

0 ^ c 

H=1 C u 



and. 



= E 



, \ 



V C ^/ 



b b T 



Using equation (2-46) we can solve for 50: 



80 = •(«, r < l , -S(V> 6' ))•*>„ 



t 1 ' 1 V c n) 



Now using equation (2-41) we calculate the Lagrangian multipliers: 






\S/ 



• (\ T 60 - « (l r « |l + S(w/’ 0*)) 



(2-64) 

(2-65) 

( 2 - 66 ) 

(2-67) 

(2-68) 

(2-69) 
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and finally we calculate: 




(2-70) 



Once we have 50 and 5\V we check to see if 0*+ 50 is in the feasible region. If 



0*+ 50 is not in the feasible region, we adjust the step size of 50 as describe earlier. 
Once we have a feasible step for 50, we calculate: 



If Z, is less then Z 0 , we accept the values of 50 and 5W and update 0* and W* using 
equation (2-47). We then move to the next iteration. If Z, is greater then Z 0 , we 
assume that we have overshot the maximum likelihood estimate, shorten 50 and 5\V 
by a factor of two, then recalculate Z,. We continue this process until Z, is less then 
Z 0 , or until 50 is negligible, at which point we have to stop the algorithm and begin 
again with a new initial value for 0‘, or more experimental data points. 



„ e*+50) 2 

Zl ^ c 

(1 = 1 C (1 



(2-71) 
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Start 



c 



3 



Collect n+ 1 measurement 
vectors m 



Order measurement vectors 
into n experiment vectors 



From Figure 2-4. c 




To Figure 2-4. b 



Figure 2— 4. a 
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From Figure 2-4. a 




To figure 2-4. c 



Figure 2-4. b 
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From Figure 2-4. b 




Figure 2-4. c 
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2.7 Accuracy of the Estimation 



One of the benefits of using Deming's method for the maximum likelihood 
estimate is that the covariance of the estimated parameters is approximated by the 
inverse of the matrix D defined by equation (2-45) [Bard 1974], This lets us quickly 
determine if the estimation of the acoustic beacon's position is acceptable, or if more 
experimental data needs to be collected to improve the estimation. We are also able to 
test if the assumptions made regarding the covariance matrix of the measurement 
errors are valid by examining the final residual vectors. We define a moment matrix 
M as: 



where the e* 's are the final residual vectors. To estimate the covariance of the 
residuals we take: 



where n is the number of experiment vectors used in the maximum likelihood 
estimation. Because of the nature of the constrained minimization problem, the first 
term in equation (2-73) is needed to correct for bias [Bard 1974], We can compare 
the outcome of equation (2-73) to the assumed covariance matrix V M defined by 
equation (2-17) to see if the estimated covariance matrix V M is valid. 



n 




(2-72) 



V = -A_ -m 



(2-73) 



« - 3 
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2.8 Summary 

In this chapter we have developed the maximum likelihood estimate of the 
acoustic beacon's position, and a means in which to gauge the accuracy of the 
estimation. To estimate the beacon's position we defined a structural model that 
requires the observer to measure the time of receipt and location of receipt of two 
different signal from the acoustic beacon. The choice of how far apart the two signals 
that define an experiment vector (w H ) must be, and the number of experiment vectors 
to use in the parameter estimation problem («) remain as free parameters. In chapter 
IV we examine the performance of the algorithm of this chapter for different choices 
of these two free parameters. 
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Chapter 111 



Moving Acoustic Beacon 

3.1 Introduction 

In chapter II we developed the maximum likelihood estimator for a stationary 
acoustic beacon. In this chapter we extend the solution to include a moving acoustic 
beacon. The task of localizing an arbitrarily moving acoustic beacon is quite difficult. 
Abrupt changes in the acoustic beacon's velocity are difficult to parameterize and 
model. Therefore, we concentrate on the case of an acoustic beacon which moves in a 
constant velocity, linear path. The assumption of constant velocity, linear motion is a 
reasonable assumption for acoustic beacons located on instruments ascending at 
terminal velocity from the bottom, or for acoustic beacons located on instruments 
moving with an ocean current that is steady in the area of interest. With the 
assumption of constant linear motion, we modify the structural model given by 
equation (2-19) to include parameters that reflect the acoustic beacon's velocity. Once 
the new structural model is defined, we show that the solution to the maximum 
likelihood estimate for the moving beacon follows directly from the solution to the 
maximum likelihood estimate for the stationary acoustic beacon. Next, the algorithm 
developed to solve the stationary acoustic beacon localization problem is extended 
using the new structural model so that the position and velocity parameters of the 
moving acoustic beacon can be determined. Finally, the accuracy of the estimator is 
examined. 
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3.2 Problem Geometry 

Consider an acoustic beacon having constant velocity components given by 
v x , v , and v 2 . We define a new parameter vector: 

0 = [ *0 ^ V, Vy V z f (3-1) 

where the coordinates x D , y 0 , and z G define the acoustic beacon's initial position on the 
same Cartesian coordinate system that was described in chapter II. For convenience, 
we assume the velocity components v x , v y , and v z have the units of meters per second. 
The position of the acoustic beacon at an arbitrary time t p can by found using: 



x T 




X o 








- 


y 0 


+ V 7 ;) 




Zj, 




. z ° . 




. v ,. 



where T 0 is the reference time that corresponds to the acoustic beacon's initial position 
*o> y D , z 0 - 

As in chapter II, we define a measurement vector m M as: 

% = t 3V *s* (3_3) 

Where x M and y M are the ship's coordinates, in meters, on the same local Cartesian 
coordinate system defined for the acoustic beacon, and t S(1 is the synchronized time of 
receipt that corresponds to the observer's position x M , y r 
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3.3 Modified Structural Model 



To account for the linearly moving acoustic beacon, we redefine the function 
f(m^ 9) from chapter II as: 

t( c, t S(1 ) 

where t p represents the time that the acoustic beacon transmitted the signal that the 
observer received at the synchronized time of receipt t sp . Using the same 
homogeneous ocean model, and direct path propagation from chapter II, we simplify 
equation (3-4) to: 



J&V 0 ) s 

(3-5) 

- C(t -T) 

V $11 O' 

Now assume that at time T 0 the acoustic beacon transmitted the first signal that the 
observer receives. To find when the current signal received at the synchronized time 
of receipt t sp was transmitted, we note that the acoustic beacon transmits a signal for 
every pulse repetition interval. With T c as a reference, t p can be found by: 

< p -- T„*i-T p (3-6) 

where T p is the pulse repetition interval of the acoustic beacon and i is number of 
pulse repetition intervals that separate the signal transmitted at time t p from the signal 
transmitted at reference time T 0 . To determine i, the observer counts how many 
signals are received between the first received signal and the signal received at the 
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synchronized time of receipt t S(J . Simplifying equation (3-5) to eliminate T 0 and t p , we 
substitute equation (3-6) into equation (3-5) which yields: 



0 ) = VW ~ x o~ l ' t p * v / + (y„ -y 9 -t %T P • v / + (v* ’ T P • v z) 2 

(J-7) 

Now, just as in the case of the stationary acoustic beacon, we must eliminate the 
dependence on the time reference T 0 from the last term in equation (3-7). 

To eliminate the dependence upon the time reference T 0 , we define the function 
g(m„ m 2 , 0) as: 



g(m v m v 0 ) =f(m v Q)-f(m v 0 ) ( 3 - 8 ) 

Substituting equation (3-7) into equation (3-8) with m, for the first received signal and 
m 2 for the second received signal we have: 



g(m v m 2 ,Q ) = forx 0 -i m T p - v J f+(y r y 0 -i-T p -vj l +(z 0 +i-T p -v t ¥ 

•VO* -Xo-J'Tp ' v xf + (y 2 ~j • T p • v) 2 +{z 0 +j -T p • vf (3 ' 9) 

" ^ f 52) 

Simplifying notation as in equation (2-13), and showing the dependence upon the true 
value of the measurements, we define the structural model for the case of the moving 
acoustic beacon as: 
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8 ( >V 0 ) = M ~ X o~ l ' T p * V / + ^l -y o ~ imT p ' V y) 2+ ( Z o +i ‘ T p * V z) 2 



-c% r i s2 ) 



(3-10) 



This is analogous to equation (2-19) with additional terms included to correct for the 
beacon's motion. 

3.4 Maximum Likelihood Estimator Solution 

The solution to the maximum likelihood estimation problem for the case of the 
moving acoustic beacon follows directly from the solution to the maximum likelihood 
estimation problem for the case of the stationary acoustic beacon. Since only the 
structural model has changed, the likelihood function log (L (\V, V)), the Lagrangian 
function A(\V, 0, V, A,,, ... ,X. n ) and the objective function 0( \V*) all have the same 
form as the corresponding functions defined for the stationary beacon. To solve for 
the maximum likelihood estimator of the parameter vector 0, we simply substitute the 
modified structural model given by equation (3-10) for the stationary structural mode 
given by equation (2-19), and follow the method of Deming described in chapter II. 
There are, however, a few differences that must be accounted for. 

If the measurement errors are the same for both cases, we still expect the 
solution to the maximum likelihood estimator to be suboptimal. Because of the 
uniform distribution of the measurement errors T S(J , we must continue to confine the 
solution of the maximum likelihood estimation problem to a feasible region. With the 
addition of the parameters v x , v y , and v z to 0, we expand the feasible region defined by 



48 



equation (2-48) to: 



-Range^ 

-Depths 




* x 0 * Range* 

* y 0 * 

* S o 



* v * * v -w 



* V * V 

J Jm 



* v < * \~ 



(3-11) 



As in chapter II, to maintain a feasible solution, we break 50 into component parts: 

e,'., - e;*se - e; *p t v t < 3 -‘ 2 > 

where U 0 is unit magnitude vector that describes the direction of 50, and p 6 is the 
magnitude of 50. We assume that 50, and therefore U 6 , points in the proper 
direction to the maximum likelihood estimator. If 0*+ 50 is outside the feasible 
region defined by equation (3-11), we find the maximum value of p that satisfies: 



-Range^ 




Range* „ 


~Range m „ 




Range^ 


-Depth t 




0 


“V 


< $ + Pmax ^6 < 


V 


*max 




■*m ax 


- v ^ 




V 


-v w 







Once we have found p max , we define the new recursion relations: 
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(3-14) 



e;., - e; * ^ u, 
ft 



K, 

ft 



As with the case of the stationary acoustic beacon, if, after a few iterations, 0* lies on 
the edge of the feasible region, p max will be zero and 0* + , will equal 0* for all 
subsequent iterations. If this happens we reject the estimate, and try again using a 
different initial value for 0* , or more experimental data points. 

3.5 Algorithm 

Figure 3-1 at the end of this section describes the algorithm used to solve for 
the acoustic beacon's position and velocity. The algorithm is essentially the same 
algorithm developed in chapter II with changes made to account for the modified 
structural model of equation (3-10). Because of the modified structural model, we 
must reevaluate the quantities a M and b M From equation (3-10), we define the 
quantities: 



4 - -yl -* v;) 2 + (zo 



(3-15) 



d 2 5 /<&* -j-T p • O 2 +(y 2 * -yl -j -T p • v y y+(Zo +j -T p • v z *) 2 



(3-16) 



a M and b H are then given by: 



50 



gi 

d i 



-c 



= ds(V> e*)/a>v ll = 



(x 2 '- x ;-j-T'v;) 



(3-17) 






b = 



dg&S, Q*)/dQ 



(x 2 '-x;-j-T- v ;) (x^-xt-vT-v;) 



d 2 d x 



d 2 d x 

’tin-T-v;) (itV,')' 



♦ v \ 



;-W- Xg-j-r 'v‘) i-TJx;-x;-iT- v ;) 









rr/*- y:-j-T p -v;) y ;-iT p v;) 

d 2 d, 

■T'ti+i-T'-v;) _ ryX±]jri) 
d\ d 2 



(3-18) 



51 



To evaluate the structural model, and the terms a p and b p ,we need to know the 
values of / and j that represent the time that the received signals were transmitted. 

This forces the observer to keep a count of the number of signals that are received, 
with the first received signal corresponding to i = 0. 

Once we have found the maximum likelihood estimate of the parameter vector 
0, we need to evaluate the estimated current position of the acoustic beacon. The 
position defined by x 0 *, y 0 *, z 0 * is the estimated initial position of the acoustic beacon 
at the time T 0 . We assume that the time T 0 corresponds to the case i = 0. To 
determine the current position of the acoustic beacon, we project the solution forward 
along the path described by the estimated velocity components v y *, v z *. The 
estimated current position of the acoustic beacon is then given by: 



* 

Xj> 




1 




1 

V 


y-r 


= 


y' 0 


*i-T„ 


V J 


* 

ZT 




* 

Zq 







(3-19) 



where / is the total number of beacon signals received and T p is the pulse repetition 
interval of the acoustic beacon. The quantity (; • T p ) represents the time it took to 
collect the measurements used to calculate the maximum likelihood estimator. 
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To Figure 3-l.b 



Figure 3-1. a 
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From Figure 3-1. a 




To figure 3— l.c 



Figure 3 — l.b 
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From Figure 3-l.b 




Figure 3—1. c 
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3.6 Accuracy of the Estimator 

To estimate the accuracy of the solution to the maximum likelihood estimator, 
we examine the estimated covariance matrix of the parameter vector 0. As with the 
stationary beacon, the estimated covariance matrix of the parameter vector 0 is given 
by the inverse of the matrix D or: 



The variance of the velocity components v x \ v y \ and v z * are the last three diagonal 
elements of the covariance matrix Vq. 

To determine the variances of the current acoustic beacon position estimates we 
calculate: 




(3-20) 




(3-21) 





(3-23) 



Simplifying equations (3-21) through (3-23) yields: 




(3-24) 
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(3-25) 



( 3 - 26 ) 



% 2 - < ' (>%?■< * 2 v- T ,n^] 

-E[z < ,f-2-( i -T ( ,)£[v ! ]£[ Z „]-(iT / £[v ! ]f 

Now if we assume that the estimate of the parameter vector 0 is unbiased, we can 
substitute the estimated parameter values for their means in equations (3-24) through 
(3-26). This gives us a method in which to calculate the estimated variance of the 
projected current position: 



- {xlf -2-(i-T p )v ; *; -(i-T p -y;f 


( 3 - 27 ) 


-(y;f-2-(i-T r )v y y;-(i-T p -v;f 


( 3 - 28 ) 


< * (‘- T rf ■< ♦ 2 V T ,) E lV'] 

- -2-(i-T p ) V ; z; -(i-T p -v;f 


( 3 - 39 ) 



From equations (3-27) through (3-29) we see that the variance of the estimated current 
position has a complex relationship to the number of experiment vectors used and the 
effective sensor spacing. As these quantities increase, we expect that the variances of 
the estimated initial positions and velocities will decrease. However, as the number of 
experiment vectors used and the effective sensor spacing increases, the term i will 
increase and the variance of the estimate of the current position of the acoustic beacon 
can also increase. This is because if we project the initial position of the acoustic 
beacon forward based on the estimated velocity parameters, any errors in the acoustic 
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beacon's velocity causes us to move the estimate in the wrong direction. The choice 
of how many experiment points to collect, or how long we spend collecting data 
points, will be examined in chapter IV. 

As with the stationary beacon, we can test the assumptions made regarding the 
covariance matrix of the measurement errors. We define the moment matrix as: 

m - £ «; e; T ( 3 - 30 ) 

»-i 

where the e* 's are the final residual vectors defined as in chapter II. To estimate the 
covariance of the residuals we take: 

V=—-M (3-31) 

n- 6 

where n is the number of experiment vectors used in the maximum likelihood 
estimation. The first term in equation (3-31) corrects for the bias caused by the 
constrained minimization problem [Bard 1974], We can compare the results of 
equation (3-31) with the assumed covariance matrix of the measurement errors to 
judge if the assumed covariance matrix V M is valid. 

3.7 Summary 

In this chapter we have extended the results of chapter II to include linear 
motion of the acoustic beacon. We found that the solution to the maximum likelihood 
estimator for the case of the moving beacon follows the same form as the solution for 
the case of the stationary beacon. The quantity (j - /') is one of the free parameters of 
the moving acoustic beacon estimation problem. We define this quantity as the 
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effective sensor spacing. This quantity corresponds to the spacing in time between the 
two signals used to form the experiment vector w M . The other free parameter is the 
number of experiment vectors to use in the parameter estimation problem. In the next 
chapter we examine the performance of the algorithm described in this chapter for 
different choices of the two free parameters. 



59 



Chapter IV 



Algorithm Simulations and Tests 

4.1 Introduction 

In chapters II and III we developed algorithms to solve for the maximum 
likelihood estimate of an acoustic beacon's position for both the stationary and the 
moving beacon. In both chapters we were left with choosing how many experiment 
vectors (w M ) to use, and which measurement vectors (m M ) to use to define the 
experiment vectors. We defined the effective element spacing to be the number of 
pulse repetition intervals (T p ) between the measurement vectors that form the 
experiment vector w p . In this chapter we examine the performance of the algorithms 
developed in chapters II and III for different numbers of experiment vectors, and for 
different effective element spacings. We show that the accuracy of the estimated 
beacon position (9*) improves, while the variance of the estimated position decreases 
as the number of experiment vectors used to find the maximum likelihood estimate 
increases. We also show that the accuracy of the estimated beacon position improves, 
and the variance of the estimated position decreases with increased effective sensor 
spacing. This result is similar to the methods mentioned in chapter I. 

To test the algorithms of chapters II and III, Monte Carlo simulations were 
conducted for several different initial positions and velocities of the acoustic beacon. 
Results from six of the scenarios tested are presented in the following sections. We 
assume that the measurement errors are as defined in section 2.4. To see how the 
accuracy of the measured position of receipt (x M , y M ) affects the maximum likelihood 
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estimate, we use GPS errors of 3 meters rms and 25 meters rms. These errors 
approximate the errors of a Differential/P code GPS receiver and a C/A code GPS 
receiver respectively. For measurement errors in the synchronized time of receipt t S(1 , 
we assume the sampling rate of the receiver, T s , is 1 millisecond and use equation (2- 
16) to define the variance. 

4.2 Synthetic Measurement Vector Generation 

To test the algorithms of chapters II and III, synthetic measurement vectors 
were generated for several different acoustic beacon positions and velocities. Table 
4-1 lists the initial position and velocities for each of the scenarios presented. We 
assume that the receiving ship moves in a hexagonal search path with legs of 1000 
meters. This is a reasonable search path in the general location of the acoustic 
beacon which is easy to model. The actual path of the receiving ship is not critical. 



Scenario 


x B 

(m) 


y B 

(m) 


z B 

(m) 


v, 

(m/s) 


v y 

(m/s) 


v* 

(m/s) 


1 


0 


0 


-2000 


0 


0 


0 


2 


0 


866 


-2000 


0 


0 


0 


3 


-1000 


1000 


-2000 


0 


0 


0 


4 


0 


0 


-2000 


0.5 


-0.5 


0.25 


5 


0 


866 


-2000 


0.5 


-0.5 


0.25 


6 


-1000 


1000 


-2000 


0.5 


-0.5 


0.25 



Table 4-1 

as long as it is not linear. If the receiving ship's path is linear we will be unable to 
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accurately resolve the acoustic beacon's position in three dimensions. This is 
analogous to the inability of a conventional linear array to resolve the direction of 
arrival of a signal in two dimensions. We restrict the speed of the receiving ship to 
five meters per second so that flow noise does not become a problem. 

Figure 4-1 shows the positions of the acoustic beacon for the scenarios defined 
in Table 4-1 compared to the path of the receiving ship. 




Figure 4-1 



Scenarios 1 and 4 corresponds to an acoustic beacon located in the center of the search 
path, scenarios 2 and 5 correspond to an acoustic beacon located directly below the 
search path, and scenarios 3 and 6 correspond to an acoustic beacon located outside of 
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the search path. 

To generate the synthetic measurement vectors m M , we solve for the intercept of 
the receiving ship and the beacon signal. Figure 4-2 shows the intercept geometry. 



Figure 4-2 

The position x„ y ( is the location of the receiving ship when the beacon signal is 
transmitted, and the position x M , y M is the location of the ship when the beacon signal 
is received. Using a homogeneous ocean model and a direct path propagation mode, 
we calculate the synchronized time of receipt by finding the positive root of: 




Acoustic Beacon 
Location 



(x,. y„- z b ) 



a -t 2 + p 't +y = 0 



(4-1) 



where: 




P = 2‘5-[cos(cse)-(^ | -Jc B ) + sin(cse)-(y | .- 3 ' B )] 

Y = {x r x B f*{y r y B f*zl 



(4-2) 
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Here s is the speed of the receiving ship in meters per second, C is the speed of sound 
in sea water, and cse is the course of the receiving ship in degrees. It is assumed that 
the receiving ship does not change its course for the duration of the calculation. Once 
we have the synchronized time of receipt, we calculate the position of receipt x M , y M 
using: 



*„ = x i + t Sil ’S-cos(cse) 
>V = y t + t s[l -s-sm(cse) 



(4-3) 



To find the next synchronized time of receipt and position of receipt (x M , y M ) 
we update the acoustic beacon's position based on its velocity: 



= X B + T p' V x 

yB = y B + T p' v y (4_4) 

z B = Z B + T p -V z 

where T p is the pulse repetition interval of the acoustic beacon. For the results 
presented in the following sections we assume the acoustic beacon has a pulse 
repetition interval of 2 seconds. Next we find the location of the receiving ship when 
the new beacon signal is transmitted using: 



X i = x i + T p -s • cos(cse) 
y; = + T p -s • sin(cse) 



(4-5) 



We then solve for the intercept of the beacon signal and the receiving ship using 
equations (4-1) and (4-2). We continue in this manner until we have generated a 
sufficient number of measurement vectors m M . Once we have generated the 
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measurement vectors, we add normally distributed random error terms to each 
measurement based upon the errors discussed in section 2.4. 

4.3 Stationary Acoustic Beacon 

In this section we examine the performance of the algorithm given in Figure 
2-4. Figures 4-3 through 4-50 contain the results of the Monte Carlo simulations 
conducted for scenarios 1 through 3. For each scenario, the initial value of the 
estimated parameter vector 0* is taken as: 

0o = [ 0 0 -2500 f ( 4 ’ 6 ) 

The feasible region is defined by Range max = Depth max = 5000 meters. If the maximum 
likelihood estimate found using the algorithm of chapter II is outside the feasible 
region, the corresponding entries are left blank. To find a solution for these cases, we 
need to start with a different initial parameter vector 0*, or use more experiment 
vectors. 

To test the effect of increasing the number of experiment vectors (/?), we solve 
for the estimated parameter vector 0* using n ranging from 5 to 50. We fix the 
effective sensor spacing at 45 pulse repetition intervals by using every 45 th received 
beacon signal in defining the experiment vectors. To test the effects of increasing the 
effective sensor spacing, we solve for the estimated position vector using effective 
sensor spacings ranging from 2 to 90 pulse repetition intervals. For this case we fix 
the number of experiment vectors used to 25. We conduct each experiment using GPS 
errors of 3 meters rms and 25 meters rms. The results of the estimation algorithm for 
GPS errors of 3 meters rms are shown by x's on the plots, while the results of the 
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estimation algorithm for GPS errors of 25 meters rms are shown by o's. 

4.3.1 Scenario 1 - Stationary Acoustic Beacon Located at 0 = [0 0 -2000] 1 
Figures 4-3 through 4-10 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-1 1 
through 4-18 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 1. We see that in general, as the 
number of experiment vectors used in the maximum likelihood estimation problem 
increases, the accuracy of the estimated beacon position improves, and the standard 
deviation of the estimated position decreases. Also, as the effective sensor spacing 
increases, the accuracy of the estimated beacon position improves, and the standard 
deviation of the estimated position decreases. For both cases, the position errors and 
the standard deviation of the estimates initially decrease rapidly as the receiving ship 
spans more of its two dimensional search path. However after the number of 
experiment vectors used reaches approximately 20, or after the effective sensor spacing 
reaches approximately 35, the errors and the standard deviations decrease at much 
slower rate. At this point the receiving ship has completed two legs of the search 
path, and spans enough of the two dimensional search path to form a decent estimate 
of the acoustic beacon's position. 
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XT vs Number of Experiment Vectors Standard Deviation of XT 
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XT vs Effective Sensor Spacing Standard Deviation of XT 
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4.3.2 Scenario 2 - Stationary Acoustic Beacon Located at 0 = [0 866 -2000] 1 

Figures 4-19 through 4-26 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and Figures 4-27 
through 4-34 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 2. Like scenario 1, as the number of 
experiment vectors used in the maximum likelihood estimation problem increases, the 
accuracy of the estimated beacon position improves, and the standard deviation of the 
estimated position decreases. Also like scenario 1, as the effective sensor spacing 
increases, the accuracy of the estimated beacon position improves, and the standard 
deviation of the estimated position decreases. Again we see an initial rapid decrease 
in the errors and standard deviations which levels off after the number of experiment 
vectors used reaches approximately 20, or the effective sensor spacing reaches 
approximately 35. As in scenario 1, these values correspond to when the receiving 
ship completes the second leg of the search path. 

Unlike scenario 1, we see a significant improvement in the estimated position 
(especially when using 25 meter GPS errors) when the number of experiment vectors 
used is greater then 40, or the effective sensor spacing is greater then 65. At this 
point the receiving ship passes directly over the acoustic beacon and begins moving 
away from the beacon on the fourth leg of the search path. To see why we get this 
improvement, we can define a vertical plane as the plane orthogonal to the x-y plane 
that passes through the acoustic beacon's position and the starting point of the leg of 
the search path that the receiving ship is currently on. In general, it was found that if 
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the receiving ship moves such that it stays in this vertical plane, significant 
improvements to the estimated beacon location can be made. This is because as the 
receiving ship moves in the same vertical plane relative to the acoustic beacon, the 
localization problem is essentially a two dimensional problem, and the range 
differences between measurement vectors is maximized for a given ship's velocity. 
The same is true if the acoustic beacon and the receiving ship are in the same 
horizontal plane. 
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XT vs Number of Experiment Vectors Standard Deviation of XT 
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ZT vs Number of Experiment Vectors Standard Deviation of ZT 
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XT vs Effective Sensor Spacing Standard Deviation of XT 
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43.3 Scenario 3 - Stationary Acoustic Beacon Located at 0 = [-1000 1000 -2000] 1 

Figures 4-35 through 4-42 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-43 
through 4-50 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacing for scenario 3. Like the first two scenarios, as the 
number of experiment vectors used in the maximum likelihood estimation problem 
increases, the accuracy of the estimated beacon position improves, while the standard 
deviation of the estimated position decreases. Also, as the effective sensor spacing 
increases, the accuracy of the estimated beacon position improves, while the standard 
deviation of the estimated position decreases. Again we see an initial rapid decrease 
in the errors and standard deviations which levels off after the number of experiment 
vectors used reaches approximately 20, and the effective sensor spacing reaches 
approximately 35. As in the first two scenarios, these values correspond to when the 
receiving ship completes the second leg of the search path. 

In this scenario, we see a significant improvement in the location estimate 
when the number of experiment vectors used is greater then 45, or when the effective 
element spacing is greater then 75. At this point the receiving ship passes through the 
closest point of approach to the acoustic beacon on the fifth leg of the search path. In 
general, it was found that the estimate of the acoustic beacon's location improves as 
the receiving ship passes through closest points of approach to the acoustic beacon 
along the search path. 
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XT vs Effective Sensor Spacing Standard Deviation of XT 
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4.3.4 Stationary Acoustic Beacon Summary 

From scenarios 1 through 3 we showed that as the number of experiment 
vectors used in the maximum likelihood estimation problem increases, the accuracy of 
the estimated beacon position improves, while the standard deviation of the estimated 
position decreases. Also, as the effective sensor spacing increases, the accuracy of the 
estimated beacon position improves, while the standard deviation of the estimated 
position decreases. We also showed that as the receiving ship passes through a closest 
point of approach, the estimated position of the acoustic beacon improves. This is 
why the estimate of acoustic beacon's location in scenario 1 is better then the estimates 
obtained for the other two scenarios. In scenario 1, each leg of the search path passes 
through a closest point of approach. This is not true for the other two scenarios. In 
all of the scenarios, we see that the depth of the acoustic beacon is the least accurately 
estimated parameter. This is because we are attempting to locate the acoustic beacon 
in three dimensions, while the receiving ship only moves in two dimensions. Finally, 
we see that the accuracy of the estimated acoustic beacon position obtained from using 
GPS errors of 3 meters is approximately an order of magnitude better then the 
estimated acoustic beacon position obtained from using GPS errors of 25 meters. 

These observations suggest that to obtain the best possible estimate of the 
acoustic beacon's location, we need to use a large number of experiment vectors with a 
large effective sensor separation, and we need to use a Differential/P code GPS 
receiver. The problem with this is that the time it takes to collect the measurement 
vectors used to form the experiment vectors increases with increasing sensor spacing 
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and increasing numbers of experiment vectors. As an example, with an effective 
sensor spacing of 45 pulse repetition intervals, a pulse repetition interval of 2 seconds, 
and using 50 experiment vectors it takes over 76 minutes to collect the required 
measurement vectors. If time is an issue, then we must use fewer experiment vectors 
and shorter effective sensor spacings. From looking at the results of the simulations 
presented above, for the hexagonal search path of Figure 4-1 and for a pulse repetition 
interval of 2 seconds, the minimum required number of experiment vectors is 20, and 
the minimum effective sensor spacing is 35. With these values we span enough of the 
two dimensional search path to obtain a decent estimate of the acoustic beacon's 
location. 

4.4 Moving Acoustic Beacon 

In this section we examine the performance of the algorithm given in Figure 
3-1. Figures 4-51 through 4-146 contain the results of the Monte Carlo simulations 
conducted for scenarios 4 through 6. For each scenario, the initial value of the 
estimated parameter vector 0’ is taken as: 

e; = [ 0 0 -2500 0 0 0 f ( 4 - ? ) 

The feasible region is defined by Range max = Depth max = 5000 meters, and v xmax = 
v ymax = v^^ = 5 meters per second. If the maximum likelihood estimate found using 
the algorithm of chapter III is outside the feasible region, the corresponding entries are 
left blank. To Find a solution for these cases, we need to start with a different initial 
parameter vector 0, or use more experiment vectors. 

To test the effect of increasing the number of experiment vectors ( n ), we solve 
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for the estimated parameter vector 0* using n ranging from 10 to 50. We fix the 
effective sensor spacing at 60 pulse repetition intervals by using every 60 th received 
beacon signal in defining the experiment vectors. To test the effect of increasing the 
effective sensor spacing, we solve for the estimated position vector using effective 
sensor spacings ranging from 2 to 90 pulse repetition intervals. For this case we fix 
the number of experiment vectors used to 30. We conduct each experiment using GPS 
errors of 3 meters rms and 25 meters rms. The results of the estimation algorithm for 
GPS errors of 3 meters rms are shown by x's on the plots, while the results of the 
estimation algorithm for GPS errors of 25 meters rms is shown by o's. 

4.4.1 Scenario 4 - Moving Acoustic Beacon Located at: 

0 = [0 0 -2000 0.5 -0.5 0.25] t 

Figures 4-51 through 4-66 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-67 
through 4-82 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 4. Similar to the stationary acoustic 
beacon scenarios, we see that as the number of experiment vectors used in the 
maximum likelihood estimation problem increases, the accuracy of the estimated 
position and velocities of the acoustic beacon improves, while the standard deviation 
of the estimated position and velocities decrease. We also see that as the effective 
sensor spacing increases, the accuracy of the estimated position and velocities of the 
acoustic beacon improves, and the standard deviation of the estimated position 
decreases. As with the stationary acoustic beacon, the position and velocity errors 
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initially decrease rapidly, however, after the number of experiment vectors used 
reaches approximately 30, or the effective sensor spacing reaches approximately 45, 
the errors and the standard deviations decrease much slower. 

Figures 4-61 through 4-66 and figures 4-77 through 4-82 show the estimation 
algorithm's ability to track the linearly moving acoustic beacon. We see that projected 
current positions follow the linearly moving acoustic beacon fairly well when using 3 
meter GPS errors. We also see that the standard deviation of the projected current 
positions decrease as the number of experiment vectors used increases and the 
effective sensor spacing increases. However, we notice in a few cases the standard 
deviations increase slightly for increasing numbers of experiment vectors used and 
increasing effective sensor spacing. This is a result of projecting the current position 
forward in time using equation 3-19. 
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Zo vs Number of Experiment Vectors ^ 0 4 Standard Deviation of Zo 
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Projected Current Position YT x 10 4 Standard Deviation of YT 





89 



-5000 



Xo vs Effective Sensor Spacing x ^ Q 4 Standard Deviation of Xo 




O 

O 



o 

00 



o 

CD 



O 



o 

CNJ 



O 




SJ0J0UU 





CM 



(SJ0}0UJ) OX 



(SJ0J0UJ) OA 



CNJ 

i 



90 



D 40 60 80 100 0 20 40 60 80 100 

Effective Sensor Spacing Effective Sensor Spacing 



Zo vs Effective Sensor Spacing x< l 0 4 Standard Deviation of Zo 




o 

o 



o 

00 



o 

CD 



O 



o 

CM 



o 



O) 

c 

o 

CO 

CL 

CD 



O 

CO 

c 

<D 

CD 

CD 

> 

O 

LU 




PUOO0S/SJ0J0W 




O O O O O O 

O if) O to O to 

T V CN C? C? 

(SJ0J0UJ) 0Z 



O 

o 



o 

00 



o 

CD 



O 



o 

CM 



o 



O) 

c 

o 

CO 

Q. 

CD 

o 

CO 

c 

CD 



CD 

<1) 

> 

o 

£ 



LU 




puooes/sjejeuj 



91 



3 40 60 80 100 0 20 40 60 80 100 

Effective Sensor Spacing Effective Sensor Spacing 



Magnitude of Position Error (Xo,Yo,Zo) Magnitude of Position Error (Xo.Yo) 




sjejeiu 




92 



D 40 60 80 100 0 20 40 60 80 100 

Effective Sensor Spacing Effective Sensor Spacing 



Projected Current Position YT ^ Q 4 Standard Deviation of YT 




O 

O 



o 

CO 



CO 



o 

^r 



o 

CM 




SJ0J0LU 




93 



D 40 60 80 100 0 20 40 60 80 100 

Effective Sensor Spacing Effective Sensor Spacing 



4.4.2 Scenario 5 - Moving Acoustic Beacon Located at: 

0 = [0 866 -2000 0.5 -0.5 0.25] T 

Figures 4-83 through 4-98 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and figures 4-99 
through 4-114 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 5. Similar to the previous scenarios, 
we see that as the number of experiment vectors used in the maximum likelihood 
estimation problem increases, the accuracy of the estimated position and velocities of 
the acoustic beacon improves, while the standard deviation of the estimated position 
and velocities decrease. We also see that as the effective sensor spacing increases, the 
accuracy of the estimated position and velocities of the acoustic beacon improves, and 
the standard deviation of the estimated position decreases. As before, the position and 
velocity errors initially decrease rapidly, however after the number of experiment 
vectors used reaches approximately 30, and the effective sensor spacing reaches 
approximately 45, the errors and the standard deviations decrease much slower. 

Figures 4-93 through 4-98 and figures 4-109 through 4-114 show the estimation 
algorithm's ability to track the linearly moving acoustic beacon for this scenario. We 
see that the projected current positions follow the linearly moving acoustic beacon 
fairly well for both 3 meter and 25 meter GPS errors. This is because the estimated 
initial positions x 0 , y Q , and z 0 obtained using 25 meter GPS errors were better in this 
scenario then for scenario 4. In general this is not the case, however the measurement 
errors in this scenario simply led to a better estimate of the acoustic beacon's position. 
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Xo vs Number of Experiment Vectors x 1 Q 4 Standard Deviation of Xo 
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Projected Current Position YT ^q 4 Standard Deviation of YT 
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Xo vs Effective Sensor Spacing ^q 4 Standard Deviation of Xo 
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Zo vs Effective Sensor Spacing ^ 0 4 Standard Deviation of Zo 
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Projected Current Position YT ^q 4 Standard Deviation of YT 
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4.4.3 Scenario 6 - Moving Acoustic Beacon Located at: 

0 = [-10000 1000 -2000 0.5 -0.5 0.25[ T 

Figures 4-1 15 through 4-130 show the results of the maximum likelihood 
estimation algorithm for different numbers of experiment vectors, and Figures 4-131 
through 4-146 show the results of the maximum likelihood estimation algorithm for 
different effective sensor spacings for scenario 6. Again we see that as the number of 
experiment vectors used in the maximum likelihood estimation problem increases, the 
accuracy of the estimated position and velocities of the acoustic beacon improves, and 
the standard deviation of the estimated position and velocities decrease. We also see 
that as the effective sensor spacing increases, the accuracy of the estimated position 
and velocities of the acoustic beacon improves, while the standard deviation of the 
estimated position decreases. As before, the position and velocity errors initially 
decrease rapidly, however after the number of experiment vectors used reaches 
approximately 30, or the effective sensor spacing reaches approximately 45, the errors 
and the standard deviations decrease much slower. 

Figures 4-125 through 4-130 and Figures 4-141 through 4-146 show the 
estimation algorithm's ability to track the linearly moving acoustic beacon for this 
scenario. We see that the projected current positions follow the linearly moving 
acoustic beacon fairly well using 3 meter GPS errors. Again, because of the errors in 
estimating the acoustic beacon's initial positions x 0 , y 0 , and z Q , the projected current 
position obtained from using 25 meter GPS errors does not track the acoustic beacon's 
motion as well. 
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Xo vs Number of Experiment Vectors ^ 0 4 Standard Deviation of Xo 
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Zo vs Number of Experiment Vectors x 1 Q 4 Standard Deviation of Zo 




o 

to 



o 



o 

CO 



o 

CM 



O 



c 




PUOO0S/SJ0J8UJ 




i 

(SJ818LU) 02 




i 

puooes/sjejeiu 



105 



- 1.5 



Magnitude of Position Error (Xo,Yo,Zo) Magnitude of Position Error (Xo.Yo) 

IOOOi z 1 1 1 1 500i 1 • 1 1 



<N 



<D 

13 

O) 



o 



o 






o 

LO 



o 



o 

00 



o 

c\| 



c 



400 


300 

200 


100 


O 




SJ0J0LU 








o 



o 

to 



o 



o 

oo 



o 

CN 



o 



c 



SJ0J0UU 




106 



Projected Current Position YT x IQ 4 Standard Deviation of YT 
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Xo vs Effective Sensor Spacing 10 4 Standard Deviation of Xo 
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Zo vs Effective Sensor Spacing 10 4 Standard Deviation of Zo 
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Projected Current Position YT x 1 Q 4 Standard Deviation of YT 
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4.4.4 Moving Acoustic Beacon Summary 

From scenarios 4 through 6 we showed that as the number of experiment 
vectors used in the maximum likelihood estimation problem increases, the accuracy of 
the estimated position and velocities of the acoustic beacon improves, while the 
standard deviation of the estimated position decreases. Also, as the effective sensor 
spacing increases, the accuracy of the estimated position and velocities of the acoustic 
beacon improves, and the standard deviation of the estimated position decreases. For 
all of the moving acoustic beacon scenarios, we see that the depth of the acoustic 
beacon is the least accurately estimated parameter. This is because we are still 
attempting to locate the acoustic beacon in three dimensions, while the receiving ship 
only moves in two dimensions. We also note that the standard deviations of the 
estimated beacon position are significantly larger for the moving beacon scenarios then 
for the stationary beacon scenarios. These larger standard deviations are due to the 
nature of the structural model and reflect the difficulties in locating a moving acoustic 
beacon using only a single omnidirectional hydrophone as a receiving source. 

Similar to the stationary acoustic beacon scenarios, to obtain the best possible 
estimate of the acoustic beacon's location we need to use a large number of experiment 
vectors with a large effective sensor spacing. Again we run into problems with the 
time it takes to collect the required measurement vectors. For example, with an 
effective sensor spacing of 60 pulse repetition intervals, a pulse repetition interval of 2 
seconds, and using 50 experiment vectors it takes 100 minutes to collect the required 
measurement vectors. As with the stationary acoustic beacon scenarios, if time is an 
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issue, we must reduce the number of experiment vectors used, and reduce the 
effective sensor spacing. As a minimum, we must use at least 30 experiment vectors 
and a minimum effective sensor spacing of 45 pulse repetition intervals. With these 
values, for the search path of figure 4-1 and for a pulse repetition interval of 2 
seconds, we should be able to obtain a decent estimate of the acoustic beacon’s 
position and velocities. 

4.5 Summary 

From the results of the Monte Carlo simulations we see that in general, as the 
number of experiment vectors used to find the estimated parameter vector 0 increases, 
the errors of the estimated parameters and the variance of the estimated parameter 
vector deceases. This implied that to obtain the best estimate of the acoustic beacon's 
location, we should use a large number of experiment vectors, with a large effective 
sensor spacing. We run into problems with this is approach if the time it takes to 
obtain an estimated position is a factor. We showed that for the search path given in 
section 4.2 and for an acoustic beacon with a pulse repetition interval of 2 seconds, we 
need to use a minimum of 20 experiment vectors and an effective sensor spacing of 35 
pulse repetition intervals to obtain a decent estimate when using the stationary acoustic 
beacon algorithm. We also showed that with the same search path and pulse repetition 
interval, we need to use a minimum of 30 experiment vectors and an effective sensor 
spacing of 45 pulse repetition intervals. In all scenarios, the use of accurate 
navigational equipment to measure the position of the receiving ship is critical to 
obtain an accurate estimate of the acoustic beacon's location. This is shown by the 
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better estimates obtained from using Differential/P code GPS errors of 3 meters rms. 
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Chapter V 



Receiver Design 

5.1 Introduction 

A receiver must be designed to implement the maximum likelihood estimation 
algorithms described in chapters II and III. This receiver should fulfill the goals of 
being an inexpensive, lightweight, easily transported receiver that can perform all of 
the functions of an older chart recorder To determine the specifications for the 
receiver hardware, we look at the signal that is received, the ambient noise that is 
received, the thermal noise generated by the receiver's preamplifier, and the required 
signal output. We also examine the characteristics of the hydrophone used as a 
receiving sensor, and develop a practical hydrophone model so the preamplifier's input 
characteristics can be determined. 

In designing a receiver to implement the algorithms described in chapters II 
and III, we make the following general assumptions. We assume that the beacon 
signal has a carrier frequency of 10,000 Hertz, a pulse width of 10 milliseconds, and a 
pulse repetition interval of 2 seconds. This is similar to several acoustic beacons 
currently in use. To cut costs, a Motorola 68HC11 microcontroller will be used. The 
68HC11 is an 8-bit, low power microcontroller with several useful peripheral 
functions built in. These peripheral functions include an eight channel 8-bit analog to 
digital (A/D) converter, an asynchronous serial communications interface, five general 
input/output ports, and a 16-bit free running timer system with five output compare 
registers. This lets us use a single chip to synchronize the time of receipt t M to the 
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pulse repetition interval, digitally sample the received signal, control the receiver's 
gain, and communicate with the interfacing computer. Another factor in deciding to 
use the 68HC11 microcontroller is that the 68HC11 and it's programming support 
equipment are commonly available. For the receiving sensor, we use the Benthos 
AQ-4 hydrophone attached to 100 meters of RG-58/u coaxial cable. The Benthos 
AQ-4 hydrophone has an open circuit response of -201 dB re 1 Volt per IpPa, which 
is representative of the type of omnidirectional hydrophones currently available. 

5.2 Design Criterion 

The signal transmitted by the acoustic beacon can be characterized as a 
sequence of gated continuous wave pulses at a carrier frequency^. We depict the 
beacon signal as: 



where w(t) is a windowing function that defines the pulse width, T p is the period 
which defines the pulse repetition interval, and <j) is a phase term. As before, the 
coefficient T 0 represents the unknown absolute time reference. 

We can represent the signal that is received by the observer as: 



where h x represents the attenuation the signal experiences in traveling from the beacon 
to the observer, and Q represents a random phase distortion due the propagation of 




(5-1) 
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the signal through the ocean. As discussed in chapter II, the term t represents the 
synchronized time of receipt and is given by: 

t = t - i-T = T d + T (5-3) 

•SJi (1 p R o v/ 

where T R is the acoustic travel time of the beacon signal. The term n(t) represents 
the combination of the ambient noise that is received and the thermal noise that is 
generated by the receiver's preamplifier. 

Since we use range differences in the maximum likelihood estimation 
algorithms of chapters II and III, the parameter that we need to find from the received 
signal is the synchronized time of receipt t S(1 . In order to find t S(1 , we digitally process 
the received signal. To determine the proper sampling rate, we must look at the 
frequency content of the received signal and the desired accuracy of the synchronized 
time of receipt t SM . If we apply the Nyquist sampling rate theorem directly to the 
received signal, the sampling rate would have to be greater then twice the carrier 
frequency^. For carrier frequencies around 10,000 Hertz, the required sampling rate 
is too fast for the 68HC11 to handle both the data collection and the signal processing. 
However, from looking at equation (5-2), we notice that the received windowing 
function w(t) contains the parameter t S(1 . Therefore, if we remove the carrier frequency 
and just look at the envelope of the received signal given by w(t), we can still 
determine the synchronized time of receipt by observing when the signal's envelope is 
received. To remove the carrier frequency / c , we use a precision rectifying circuit 
with a low pass filter to form an envelope detector. This allows us sample at the 
reduced rate of twice the bandwidth of the signal's envelope given by w(t). 
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To reduce the receiver's overall noise level, the bandwidth of the receiver 
should match the bandwidth of the envelope. If the bandwidth of the receiver 
increases above the bandwidth of the received signal's envelope, out of band noise 
from the oceanic environment and other interference sources enters the receiver, 
decreasing the signal to noise ratio. On the other hand, if the receiver's bandwidth is 
less then the bandwidth of the received signal's envelope, we do not allow the full 
bandwidth of the envelope to pass through the receiver, which again lowers the signal 
to noise ratio. The windowing function w(t) can be approximated by a simple 
rectangular window with a duration equal to the pulse width of the signal. The 
bandwidth of the windowing function and the receiver is then given by: 

Bandwidth = ( 5 ~ 4 ) 

PuL se Width 

For a pulse width of 10 milliseconds, the windowing function's bandwidth is 100 
Hertz. With a bandwidth of 100 Hertz, the sampling frequency must then be at least 
200 Hertz, which equates to a sampling interval of no more then 5 milliseconds. 

We must be careful not to sample at too slow a rate, otherwise the errors 
associated with the quantization of the time base will cause large errors in the 
localization algorithms. To determine an acceptable quantization step size, or 
equivalently, how much error can we tolerate in the time of receipt data, we need to 
compare the quantization errors to the errors in measuring the observer's location. The 
source of error in measuring the observers position is due to errors in the GPS position 
data. For a C/A-code GPS receiver, the published rms errors are on the order of 25 
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meters. Using a simple homogeneous, direct path propagation model with the speed of 
sound in water equal to 1500 meters per second, a signal takes 16.667 milliseconds to 
travel 25 meters. We call this the equivalent time error of the position error. We 
would like the errors associated with the quantization of the time base to be less than 
the equivalent time error of the position errors. Assuming no other errors in the time 
of receipt, the maximum error in measuring the time of arrival t S(1 is half the sampling 
interval. For a C/A code GPS receiver the required sampling interval of 5 
milliseconds is much less then the equivalent time error of the position error, therefore 
the quantization errors are relatively small compared to the errors in measuring the 
observer's position. However, because more accurate navigational equipment will 
most likely be available in the near future, and because the 68HC11 has the required 
speed, we will sample the received signal's envelope every 1 millisecond. With a 
sampling interval of 1 millisecond, as long as the rms errors of the navigational system 
are greater than 1.5 meters, the quantization errors will be smaller then the equivalent 
time errors of the position errors. 

To determine the synchronized time of receipt t SM from the sampled envelope, 
we pass the sampled envelope through a matched filter based upon w(t), and look for 
the time that corresponds to the maximum value of the output of the matched filter. 

The received time is then divided modulo the pulse repetition interval to obtain the 
synchronized time of receipt. The use of a matched filter has two benefits. First, the 
output of a matched filter for a rectangular input signal with the same pulse width of 
w(t) will have a unique maximum peak which we can use to calculate the time of 
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receipt. Secondly, a matched filter produces an output with the maximum signal to 
noise ratio. The digital form of a matched filter for a rectangular signal has the form 
of the moving average: 



1 N 

y[n] = 52 ■*[«“*] ( 5_5 ) 

N+ 1 fa 

For a pulse width of 10 milliseconds and a sampling rate of 1 millisecond, N is equal 
to 10. Figures 5-1 and 5-2 show the output of the moving average matched filter for 
an input that represents the sampled envelope of the received signal with additive 
noise. From figure 5-2 we see that it is relatively easy to find the maximum value of 
the output of the matched filter. We do not have to worry about the phase delay of 
the matched filter because we compare the time of arrival of two signals relative to 
each other. Since the phase delay is the same for all received signals, it does not 
effect the comparison of the two arrival times. 
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Figure 5-2 

The receiver should be able to detect the target's beacon signal in the presence 
of the additive noise term n(t). The two largest contributors of noise are ambient 
oceanic noise and thermal noise generated by the receiver's preamplifier. Ambient 
oceanic noise, due to factors such as wind force, ships, industrial activity, 
precipitation, biologies, and others, is received by the hydrophone which generates an 
equivalent noise voltage. Using the hydrophone's open circuit response 
characteristics, the receiver's bandwidth, and empirical data of noise spectrum levels 
summarized by Wenz [Wenz 1962], the equivalent noise voltage of the oceanic noise 
can be calculated using: 



. “°H < 5 -«> 



where H oc is the hydrophones open circuit response in dB re 1 Volt per IpPa, e D is the 
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ambient oceanic noise in dB re IpPa, and BW is the receiver's bandwidth in Hertz. 
Table 5-1 shows the equivalent noise voltage for various Sea states (Beaufort Scale) at 
10,000 Hertz using a hydrophone with an open circuit receiver response of -201 dB re 
1 Volt per lpPa, and a receiver bandwidth of 100 Hertz. Ideally the noise in a 
receiver should be dominated by external noise sources. This means that the receiver's 
thermal noise should be less then the ambient oceanic noise. Since sea states 1 and 2 
are not common, the receiver's thermal noise is designed to be less then the ambient 
oceanic noise associated with sea state 3. This requirement limits the test receiver's 
thermal noise reflected at the input of the preamplifier to be less then 89 nV/VHz. 



Sea State 
(Beaufort Scale) 


Ambient Oceanic 
Noise 

(dB re ljiPa) 


Equivalent 
Noise Voltage 
(nV/V Hz) 


Total Equivalent 
Noise Voltage e„ 
(pV) 


1 


48 


22 


0.22 


2 


56 


56 


0.56 


3 


60 


89 


0.89 


5 


68 


224 


2.24 


8 


73 


398 


3.98 


limit 


80 


891 


8.91 



Table 5-1 

Another desirable characteristic of the receiver is that it should have as large a 
dynamic resolution as possible. A large dynamic resolution allows the receiver to 
detect a broad level of signal amplitudes for a set gain. Since the received signal will 
be digitally processed, we need to look at the dynamic resolution of the A/D converter. 
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The dynamic resolution of an A/D converter is given by: 



Dynamic Resolution = 20 log 10 (2 Wo ) (5-7) 

For and 8 bit A/D converter, the dynamic resolution is only 



20 log, 0 (2 8 ) = 48 dB (5-8) 

This is not quite large enough. We would like a dynamic resolution that is 
comparable to the dynamic resolution of the older paper recorders. This means we 
need a dynamic resolution of at least 60 dB. To increase the dynamic resolution, 
either a higher bit A/D converter could be used, or a logarithmic compressor can be 
used prior to digital sampling. Since we are restricted to the 8 bit A/D converter of 
the 68HC1 1, a logarithmic compressor will be used to increase the receiver's dynamic 
resolution. 

Using a logarithmic compressor, the dynamic resolution is given by: 



Dynamic Resolution = 20 • log, 0 




(5-9) 



where V sat is the saturation point of the logarithmic compressor and V mjn is the 
minimum detectable signal at the input of the logarithmic compressor. Typically, 
logarithmic compressors require an input signal that is greater then 2 mV. Below 2 
mV, the input current to the logarithmic compressor becomes comparable to the bias 
current of the matched transistors used to obtain the logarithmic dependence, and 
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subsequently the logarithmic dependence is no longer valid [Millman 1979]. For the 
receiver designed in section 5.4, V sat is approximately 8 V which gives a dynamic 
resolution of: 



/ 

Dynamic Resolution = 20-log 10 



8 

2 * 10' 3 



\ 



/ 



= 72 dB 



(5-10) 



To determine the required gain of the receiver, we need to look at the signal 
level that we are attempting to receive. We wish to be able to detect low level signals 
that are right at the noise floor of the receiver. This requires the receiver to have 
enough gain to detect a signal at the equivalent oceanic noise level of 89 nV/V^Hz. 
Since a logarithmic compressor is used just prior to A/D conversion, the required gain 
is determined by the minimum detectable level in the logarithmic compressor and the 
oceanic noise level. Using the ambient oceanic noise and the input requirements of 
the logarithmic compressor from above, the maximum required gain of the receiver is 
given by: 

= 2 • 10 3 _ = 8? dB (5 _ u) 

“ 89 • 10’ 9 

However, it is possible that the received signal could be quite a bit larger then 
the minimum signal level for a strong beacon in close proximity to the receiving ship. 
For example, a 30 Watt beacon 100 meters from the receiving hydrophone will 
produce an input signal of about 10 mV. This signal would completely saturate the 
receiver if the gain is fixed at A Vmax . To prevent the receiver from saturating, some 
form of feedback gain control is needed. Using one of the output ports of the 68HC1 1 
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as a control line, simple resistive attenuators can be switched on or off to reduce or 
increase the gain of the receiver based upon the maximum signal level at the A/D 
converter. To determine how much attenuation is needed, we look at the saturation 
point of the preamplifier and the maximum likely input signal. For design purposes, 
to keep a 10 mV signal from saturating the receiver, the receiver's minimum gain is 
given by: 



A v 1— = 58rfJ3 (5-12) 

mia 1010' 3 KMO' 3 

Here again V sat is the logarithmic compressor's saturation level. Since the input 
signal level will be somewhere between the noise floor and the maximum likely input 
signal most of the time, we can use multiple resistive attenuator networks to set the 
receiver’s gain to any level in between A Vmax and A Vmin . For this design we will use 
four resistive attenuator networks to provide attenuation levels of -3 dB, -9 dB, 

-12 dB, -18 dB, -24 dB, and -30 dB. 

5.3 Hydrophone Model 

To determine the input characteristics of the preamplifier, the hydrophone and 
cable must be modeled. Figure 5-3 shows an equivalent circuit for a stiffness- 
controlled piezoelectric hydrophone. Here R h is the hydrophone's resistance, C h is the 
hydrophone's capacitance, e n represents the equivalent ambient noise of the ocean, and 
e hn represents the thermal noise of the hydrophone. For frequencies considerably 
below 100 kHz, the ambient noise level of the ocean is much greater then the 
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hydrophone’s thermal noise, while the impedance of the hydrophone is dominated by 
the capacitance C h . This allows us to simplify the hydrophone model by eliminating 
R h and e hn [Wilson 1985], 




Figure 5-3 

The cable assembly can be modeled as a two conductor transmission line. 
Using standard RG-58/u coaxial cable with a solid copper inner conductor and a 
polyethylene dielectric, we can model the cable as a series resistance R c and a shunt 
capacitance C c [Cheng 1983], Standard RG-58/u coaxial cable has a series resistance 
of 33.31 Q per 1,000 meters, and shunt capacitance of 70 pF per meter. Combing the 
simplified hydrophone model and the cable model, we have the circuit of figure 5- 4. 



Figure 5-4 
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Figure 5-4 can be simplified to give the equivalent Thevinin circuit model: 




Figure 5-5 

The source impedance Z s (/) is given by: 



Z s (f) = 



2jnfR e C h + 1 

[ 2 j t ifR c C h C c +(C h + C c )] 2 j t if 



(5-13) 



Figure 5-6 shows a plot of the source impedance verses frequency for the Benthos 
AQ-4 hydrophone with C h specified as 2,400 pF ±25%. To prevent serious loading 
effects, the preamplifier's input impedance must be considerably larger then the source 
impedance given by equation (5-13). For design purposes, the magnitude of the 
source impedance at 10,000 Hertz is 1,693 Cl, therefore we choose the preamplifier's 
input impedance to be at a minimum of 20 time the source impedance, or 33.8 kCl. 
This will keep the loss due to loading below 0.5 dB. 
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Source Impedance Magnitude vs Frequency in Hz 

Figure 5-6 

5.4 Test Receiver Hardware Design 

Based on these design criteria, a receiver was built for testing. This section 
discuses the circuit design considerations and implementation of this test receiver. 
Figure 7 shows the general signal flow of the receiver starting with the preamplifier 
and moving to the 68HC11 microcontroller. An important theme of the receiver 
design is to avoid exotic components to minimize the cost of the receiver. 

5.4.1 Preamplifier 

Refer to the preamplifier schematic diagrams in Appendix 1 for the following 
description. The first stage of the preamplifier is a tuned N channel junction field 
effect transistor (JFET) common-source amplifier. To help keep low frequency 
ambient oceanic noise from entering the preamplifier, C 01 and R^, form a high pass 
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Figure 5-7 



filter with a cutoff frequency given by: 



fc = 



1 



2 Jt Rq 1 Cqj 



(5-14) 



To eliminate as much low frequency oceanic noise as possible but still allow for small 
changes in the acoustic beacon's carrier frequency, we chose the high pass filter cut off 
frequency as 7000 Hertz. The preamplifier's input impedance is determined by Ro, 
since the input impedance of the JFET is so large ( >10 14 Cl ). To prevent loading 
between the hydrophone source and the preamplifier we must ensure Rq, is larger then 
33.8 kQ. To ensure that the thermal noise of the preamplifier is less then equivalent 
oceanic noise of sea state 3, Ro, must be chosen such that the thermal noise of the 
parallel combination of Rq, and source impedance Z s (/) is considerably less then 
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nV/V^Hz. The thermal noise of a resistor is given by: 



e n =y/4kttt ( 5 - 15 ) 

where k is Boltzmann's constant, t is the absolute temperature in Kelvin, B is the 
bandwidth in Hertz, and R is the resistance in Ohms [Horowitz and Hill 1989]. For 
the Benthos AQ-4 hydrophone at a frequency of 10,000 Hertz Z s (/) is approximately 
1700 £1 As a result, the parallel combination of and Z s (/) will be close to the 
value of Z s (/) for R^ greater then 32 kfi, and the associated thermal noise will be 
well below 89 nV/VHz. However, it would be nice to ensure that the thermal noise of 
the preamplifier is much less then equivalent oceanic noise of sea state 3 for any 
source impedance. To ensure this, we choose Rq, such that its thermal noise is 
approximately 45 nV/V^Hz. To meet the noise constraint, the loading constraint, and 
the cut off frequency constrain of equation (14), we choose Ro, as 120 kQ and C 0 , as 
180 pF. 

The gain of the first stage JFET common-source amplifier is given by: 



im _ -h-usyr. 



(5-16) 



where Y fs is the JFET's forward transconductance, r d is the JFET’s intrinsic drain 
resistance, and Z D (/) is given by: 






ZAf) - 
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V*f + i 

^02 ^02 ^01 ^02 



(5-17) 
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Z D (/ ) represents the complex impedance of the combination of L 01 , R*, 2 , and C 02 . The 
use of the reactive load Z D (/ ) allows us to obtain the narrow bandwidth required by 
equation (5-4). The gain of the first stage will be greatest when the frequency of the 
input signal is at the resonant frequency of Z D (/). The resonant frequency of Z D (/) 
is given by: 

fr = y ( 5 - 18 ) 

2 ™ y f-oi ^02 

We want the preamplifier to have it's maximum gain at the acoustic beacon's carrier 
frequency, therefore we choose L 0 , and C 02 such that the resonant frequency equals the 
acoustic beacon's carrier frequency . In the test receiver, Q 01 is an E230 general 
purpose N channel JFET. The E230 has a nominal forward transconductance of 
1.5-1 O' 3 Siemens and a nominal intrinsic drain resistance of 12.5 kfl Using equations 
(5-16) and (5-17), and the values from Appendix 1, at a beacon frequency of 10,000 
Hz, A v , is approximately 24 dB. 

In general, the output impedance of an R-L-C tuned amplifier is quite high, 
therefore, a JFET source follower is used as a buffer immediately following the first 
stage. Resistor R^ and capacitor C 04 form a high pass filter similar to Rq, and C 01 , 
and serve to capacitively couple the JFET source follower to the tuned JFET amplifier. 
The cut off frequency of the high pass filter formed by R 04 and C 04 is given by 
equation (5-14) with R^ substituted for Rq, and C 04 substituted for C 01 . To prevent 
loading between the JFET amplifier and the JFET buffer, R„ 4 must be significantly 
larger then the output impedance of the JFET amplifier. However, we must be careful 
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in choosing so that its thermal noise, when reflected back to the input of the First 
stage, is less then 89 nV/7 Hz. Using equation (15), this limits to 560 kfl 

To enhance the performance of the JFET source follower, Q 03 and R^ are 
added as a bootstrapped load. Because the base-emitter voltage of Q 03 is 
approximately constant, the combination of Ro 5 and Q 03 cause a constant source current 
to flow through JFET Q 02 . This makes Q 02 's V GS approximately constant, which in 
return reduces nonlinearities [Horowitz and Hill 1989], This is beneficial because the 
signal level at this point in the preamplifier is still quite small. 

The first stage of the preamplifier is powered by a separate 5 Volt 3-terminal 
7805 voltage regulator. We do this to isolate the first stage from subsequent stages, 
which prevents the feedback of any noise generated by subsequent stages along the 
main power supply line. This provides Q 01 with a clean, stable supply voltage which 
is critical when working with very low level input signals. 

The second stage of the preamplifier is another tuned amplifier, this time using 
a PNP bipolar transistor. Capacitor C 05 combined with the parallel combination of the 
bias resistors R^ and R^ form another high pass filter while also serving to 
capacitively couple the JFET source follower from the first stage to the second stage. 
The cutoff frequency of the high pass filter formed by C 05 , R^ and R<j 8 is given by: 




1 



2 it C 



05 



^07 '^08 
^07 + ^08 



( 5 - 19 ) 
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For this stage, we set the high pass filter's cut off frequency at 3000 Hertz. The gain 
of the second stage is given by: 



where 



A 






-z c (f) 



(5-20) 



Z c (f) = 



(2. M? + 



y*f 

V*f 

*n C Q1 



^on^on 



(5-21) 



As in the first stage we set the resonant frequency of Z c (/ ) given by: 

fr = ( 5 - 22 ) 

2 71 \J L Q 2 ^07 

to the acoustic beacon's carrier frequency. Using equations (5-20) and (5-21) for a 
beacon frequency of 10,000 Hertz, A V2 is approximately 31 db. 

Following the PNP tuned amplifier, a simple JFET source follower is used as a 
buffer. Capacitor C 08 and resistor R 12 form yet another high pass filter while also 
capacitively coupling the output of the PNP amplifier to the input to the JFET 
follower. The cut off frequency of the high pass filter formed by C 08 and R 12 is given 
by equation (14) with C 08 substituted for C 01 and R l2 substituted for R^.and is set to 
3,000 Hertz. 

Similar to the first stage, the second gain stage is powered by a separate 5 
Volt, 3-terminal 7805 voltage regulator. Again we do this to prevent noise from being 
feedback along the power supply lines. 
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At the end of the second stage of the preamplifier the maximum gain at the 
acoustic beacon’s carrier frequency is approximately 55 dB. We are under the 
minimum required gain of 58 dB, therefore we should not have to worry about the 
first two stages of the preamplifier saturating the logarithmic compressor. However, 
we still need an additional 32 dB of gain to reach the required maximum gain of 87 
dB. Prior to the next gain stage, we include an attenuation network to prevent 
subsequent stages from saturating. 

Following the JFET source follower Q 05 , R u in combination with shunt 
resistors R 15 , R 16 , R 17 , and R l8 form a variable attenuation network which is controlled 
by the 68HC11 microcontroller. To reduce the gain of the preamplifier, any 
combination of R, 5 through R 18 can be switched to ground through two CD4053 
analog switches. Once grounded, the shunt resistors form a voltage divider with R 14 , 
and subsequently attenuate the signal. Following the shunt resistors is a simple 
common emitter amplifier that provides the final gain necessary to obtain a maximum 
of 87 dB. The gain of this stage, including the effects of the attenuator network is 
given by: 



A„ = 



-*21 



2 TzfR s C w 



*19*20 
*19 + *20 



*19*20 "! 
* _19J20_ 

W *19 + *20 J 



*19*20 

•R+ -R u 

S *19 + *20 W 



(5-23) 



• 2 h/Cqp + R s + R h 



where is the parallel combination of any shunt resistors R 1S through R 18 that are 



switched to ground. If none of the shunt resistors are switched to ground, Rj is very 
large and A v3 approaches: 
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(5-24) 






-*21 

*22 



In this case the gain of the preamplifier is at its maximum of approximately 89 dB. In 
actuality, the maximum gain will be slightly less then 89 dB due to small losses 
caused by loading between the different stages. If all of the shunt resistors are 
switched to ground, R, is at its minimum value and the gain of the preamplifier is 



approximately 56 dB. Table 5-2 summarizes which shunt resistors are switched to 
ground to obtain different levels of attenuation. 



Attenuation Level 


Shunt Resistors Switched to Ground 


0 dB 


none 


-3 dB 


R.5 


-9 dB 


R.6 


-12 dB 


R|5 atld R]6 


-18 dB 


R,7 


-24 dB 


^18 


-30 dB 


^15> ^16> ^17> 



Table 5-2 

5.4.2 Envelope Detector Circuit 

Refer to the Envelope Detector schematic diagram in Appendix 1 for the 
following description. After the preamplifier, the received signal passes through a 
unity gain buffer. This isolates the preamplifier from the envelope detector, and also 
provides the low source impedance that the precision rectifier circuit needs to function 
properly. U 07 , Q 07 , Q og , and the low pass filter combination of C 25 and R 31 are the 
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heart of the envelope detector. Diode D 01 protects U 07 during large input swings above 
the reference voltage V REF . Resistors R 29 and R 30 add bias stability to transistors Q 07 
and Q 08 . 

As the input signal at the inverting terminal of U 07 goes below the reference 
voltage at the noninverting terminal of U 07 , Q 07 is brought into the active region, 
thereby drawing Q 08 into the active region which charges capacitor C 25 . As the 
difference between the reference voltage and the input signal becomes greater, Q 07 and 
Q 08 are brought further into the active region which in turn increases the time that 
capacitor C 25 charges. When the signal at the inverting terminal of U 07 is above the 
reference voltage at the noninverting terminal of U 07 , transistor Q 07 , and subsequently 
Q 08 are cut off. The charge in capacitor C 25 is then discharged through resistor R 31 . 

As long as the time constant formed by the combination of C 25 and R 31 is much 
greater then the period of the input signal's carrier frequency, the output taken at C 25 
will be the envelope of the input signal. To ensure operation with very low level 
inputs, U 08 is chosen to have a large gain bandwidth product and a fast slew rate. 

5.4.3 Logarithmic Compressor 

Refer to the Logarithmic Compressor schematic diagram in Appendix 1 for the 
following description. Prior to logarithmic compression, we pass the received 
envelope through a noninverting amplifier with a gain of 9 dB to restore the signal 
level that was lost in the envelope detector. To obtain an output that is proportional 
the logarithm of the input, we rely on the logarithmic relation between transistor Q 09 's 
voltage and current. By using Q 09 in U 09 's feedback loop, the output of the logarithmic 
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compressor is given by. 




• K r -ln 




(5-25) 



where V T is given by: 



temperature^ 

11600 



(5-26) 



Here the temperature is in Kelvin. For room temperature, V T is approximately 0.0259. 
From equation (5-25) we note that for small input signals, the output V 0 is large, and 
for large input signals, the output V c is small. To set the zero crossing point of the 
logarithmic compressor, we choose R 40 such that: 



With R 35 equal to 10 k£>, V+ equal to 10 Volts, and V sat equal to 8 Volts, R 40 is 
approximately 12.5 kQ. V sa , represents the largest possible input to the logarithmic 
compressor. To set the maximum output level of the logarithmic compressor, we 
chose R 42 and R 43 such that the minimum input signal of 2 mV produces an output of 
5 volts. This allows us to digitally sample the output of the logarithmic compressor 
directly, without worrying about damaging the 68HCll's A/D converter. The use of 
the matched transistor Q 09 helps stabilize the temperature dependence of V T , and is 
essential to eliminate the dependence upon the reverse saturation current I 0 which 
doubles for every 10° C rise in temperature [Millman 1979], 

By taking the saturation level of the receivers as approximately 8 volts, the 




(5-27) 
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dynamic resolution of the receiver is approximately: 



Dynamic Resolution = 20 • log 



10 



2-10 



-3 



= 72 dB 



(5-28) 



To obtain the full dynamic resolution at the input to the A/D converter, the output of 
operational amplifier U I0 must be capable of going between zero and five volts. We 
would like to restrict the output of U 10 to be strictly less then 5.5 Volts to prevent 
damage to the 68HCll's A/D converter in case of a failure in the logarithmic 
compressor. To accomplish this, we step down the main positive supply voltage to 5.6 
volts using a zener diode reference. The maximum output of the CA3130 operational 
amplifier used for U 10 is about 0.5 volts below the positive supply voltage, therefore 
the output of U 10 is restricted between 0 and 5.1 volts. 

5.4.4 68HC11 Microcontroller 

Refer to the 68HC11 Microcontroller schematic diagram in Appendix 1 for the 
following description. The 68HC11 is run in expanded mode at a clock speed of 
8 MHz. Input/Output ports B and C are used to interface to the external 27HC64 



EPROM and the 62HC64 RAM chips. A 74HC373 multiplexer and a 74HC00 NAND 
GATE are used to form the proper address line controls and to transfer data to the 
external memory chips. Port PEO is used for the input to the A/D converter. The 
logarithmically compressed signal passes through a low pass filter to remove any high 
frequency noise, and then is sequentially sampled by the A/D converter. Ports PDO 
and PD1 are used for serial data output. A SCL/U 20 mA SAIL-to-low-power-logic 
converter is used to convert the 68HCll's serial data to the SAIL communication 
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protocol. The use of the SAIL communications protocol is beneficial because of it's 
simplicity, and it's ability to communicate with multiple nodes. The rest of port D's 
output lines are tied to the positive supply through 100 kQ pull up resistors to prevent 
the output lines from floating. Ports PA3, PA4, PA5, and PA7 are used to control the 
two CD4053 2 channel analog switches which control the attenuator network described 
earlier. The rest of port A's input/output lines, except PAO, are tied to ground through 
100 kfl resistors to prevent the outputs from floating. PAO is left as an external input 
for further development, and is tied to the positive supply through a 100 kf2 pull up 
resistor. 

Appendix 2 contains a listing of the program that the 68HC11 executes. 

5.4.5 Power Supply 

In the test receiver, a +10 volt power supply is used to power the preamplifier, 
the envelope detector, and the logarithmic compressor. A secondary +5 volt power 
supply is used to power the 68HC11 microcontroller. The use of a separate power 
supply for the microcontroller prevents high frequency noise generated by the digital 
components from entering the preamplifier. For the -5 V that is required by the 
logarithmic compressor, a third supply is used. This provides a better regulated 
negative supply then using a DC to DC voltage converter such as the ICL 7660 to 
generate the required -5 V. Finally, a +12 volt, 300 mA supply is provided to power 
an external GPS receiver. All four power supplies are built on a common circuit 
board and share a common ground bus. Refer to the Power Supply schematic diagram 
in Appendix 1 for the following circuit description. 
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The test receiver uses a standard power cord to connect to external power with 
a one half amp slow-blow fuse to protect the receiver in case of a short circuit. A 
Magnetek Triad F-93X transformer is used to step down the input voltage. Diodes D 0 , 
through D 04 act as a standard full wave bridge rectifier. Voltage regulator U 01 is a 
simple three terminal +12 volt regulator used to provide power to the external GPS 
receiver. Capacitor C 0I Filters the rectified supply voltage to provide an unregulated 
DC voltage to U 0I . Capacitors C 02 and C 03 are bypass capacitors used to reduce noise 
on U 0I 's input and output leads. Because of the high current requirements of the 
voltage regulator, U 0I is mounted to the chassis bottom for heat sinking. 

Voltage regulator U 02 is an adjustable four terminal voltage regulator used to 
provide the +10 volts required by the preamplifier, absolute value circuit, and the 
logarithmic compressor. Resistor Rq, and capacitor C 04 form a low pass filter which 
helps reduce high frequency feedback from the GPS receiver power supply (U 0I ). Rq, 
also acts as an attenuator, reducing the unregulated DC input voltage to regulator U 02 . 
By doing this, the power that U 02 has to sink is reduced, increasing U 02 's efficiency. 
Resistors R^, R^, and R^ form the feedback network used by U 02 to set the output 
voltage. By using an adjustable voltage regulator, the positive supply voltage can be 
set more precisely, which is needed to maintain sensitive bias points in the logarithmic 
compressor. Capacitors C 05 and C 06 are bypass capacitors similar to C 02 and C 03 . 

Voltage regulator U 03 is a simple three terminal regulator used to supply the +5 
volts required by the 68HC11 and support systems. Resistor R^ and capacitor C 07 
form another low pass filter which helps isolate the preamplifier from the 68HC11 
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microcontroller. As with R^,, reduces the unregulated DC voltage at the input of 
U 03 , reducing the power that U 03 must sink. Capacitors C og and C 09 are bypass 
capacitors similar to C 02 and C 03 . The combination of resistor R^ and LED D 05 are 
used as a power indicator, with D 05 mounted on the front panel of the chassis next to 
the power switch. 

Finally, voltage regulator U 04 is a four terminal, adjustable negative voltage 
regulator that is used to provide the -5 volts required for the logarithmic compressor. 
Resistor R 07 and capacitor C 10 form a low pass Filter which converts the rectified input 
voltage to unregulated DC. Resistors R^g, Reg, and R )0 form the feedback network 
used by U 04 to set the output voltage at -5 volts. As before, C n and C 12 are bypass 
capacitors that help reduce noise the voltage regulator's input and output lines. 

5.5 Test Receiver Performance 

To test the validity of the receiver designed in section 5.4, experiments were 
conducted to measure the actual performance of the preamplifier, envelope detector, 
and logarithmic compressor. 

5.5.1 Preamplifier Performance 

To test the performance of the preamplifier, experiments were conducted to 
measure the preamplifier's actual gain, bandwidth, and thermal noise. To measure the 
gain and bandwidth of the preamplifier, the output of the preamplifier was measured 
for sinusoidal inputs at different frequencies. The results, along with the predicted 
values are plotted in figure 5-8. From figure 5-8 we see that the actual gain of the 
preamplifier at the acoustic beacon's carrier frequency is 86 dB. This is close enough 
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Predicted Gain 

Actual Gain (dB) vs Frequency (Hz) 

Figure 5-8 

to the design goal to be acceptable. The loss in gain compared to the predicted gain is 
due to the effects of loading between the various stages and to deviations from the 
nominal values of Y fs and r d . We also note that the actual bandwidth is 120 Hz which 
is slightly larger then the predicted bandwidth. This increase is due to deviations of 
Ro 2 and R u from their nominal values and is not significant. 

To determine the actual thermal noise of the preamplifier, we short the 
preamplifier's input and measure the root mean square output using a digital 
multimeter. Assuming the preamplifier's noise is normally distributed, we correct the 
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output measurement to reflect a normal distribution by multiplying by 1.13 [Horowitz 
and Hill 1989], The preamplifier's thermal noise is then found by using: 



= 



A v sfmv 



(5-29) 



where e s is the measured output voltage, A v is the total gain of the preamplifier, and 
BW is the bandwidth of the preamplifier. Using this approach, e s was measured as 
6.8 millivolts. The preamplifier's thermal noise is then: 



e. * 1,13,6,8 1 ° 3 * 31 nV/sfHz 



(5-30) 



19275 \/l20 

To check this value we can observe the output of the preamplifier (with the input 
grounded) on an oscilloscope. To measure the preamplifier's noise, we take the peak 
value observed on the oscilloscope. Next we calculate the preamplifier's thermal noise 
using: 



6 



peak 
e n 



a v jw 



(5-31) 



This gives a rough approximation of the thermal noise of the preamplifier. V peak was 
measured as 35 mV. Using equation (5-31), the thermal noise of the preamplifier is 
roughly 28 nV/VHz. This value is of the same order of magnitude as found in 
equation (5-30), so we can assume the noise figure given in equation (5-30) is correct. 
5.5.2 Envelope Detector 

To test the performance of the envelope detector we look at the output for 
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different amplitudes of a sinusoidal input. Figure 5-9 shows the measured output of 
the envelope detector for different amplitudes of a 10,000 Hertz sinusoid input. 




Measured Output (Volts) vs Input (Volts) 

Predicted Linear Relation 

Figure 5-9 

Ideally, the envelope detector should have an output that is linearly dependent on the 
amplitude of the input sinusoid. This allows the envelope detector to accurately track 
the true envelope of the beacon signal. From Figure 5-9 we see that the measured 
output is nearly linear, therefore we expect the envelope detector to work properly. 
5.5.3 Logarithmic Compressor 

To test the performance of the logarithmic compressor, we look at the output 
for different DC voltage inputs. Figure 5-10 shows the measured output values and 
the predicted values. 
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■+■ Measured Output (Volts) vs Input (Volts) 

Predicted Output 

Figure 5-10 

From Figure 10 we see that the logarithmic compressor does not follow an exact 
logarithmic relation. However, since the output of the logarithmic compressor 
monotonically decreases throughout the full range of input values, the compressor is 
sufficiently logarithmic to achieve the dynamic resolution of equation (5-28). Since 
we achieve the desired dynamic resolution, the performance of the logarithmic 
compressor is acceptable. 

5.6 Conclusions 

In this chapter a receiver to implement the maximum likelihood estimation 
algorithms developed in chapter II and III was designed and tested. Appendix 1 
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contains the schematic diagrams of the receiver built for testing. From the tests 
conducted, we see that the test receiver meets the design criteria developed in section 
5.2. To complete the receiver, an Apple Macintosh personal computer is used for the 
final signal processing and for data display. Appendix 3 contains a listing of the 
source code used by the Macintosh for signal processing and for displaying the 
collected data. 
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Chapter VI 



Conclusion 

6.1 Observations and Summary 

In this thesis, a method to passively localize stationary and linearly moving 
acoustic beacons was developed. Because of the nonlinearities of the structural model 
g(Wj,, 0), and the errors in the measurements x M , y M , and t S|J , the localization problem 
was formulated as a constrained maximum likelihood estimation problem. To solve 
for the maximum likelihood estimate, a vector of Lagrange multipliers was introduced 
and a Lagrangian function A formed. The maximum likelihood estimate was then 
found at the stationary point of the Lagrangian function. Figures 2-4 and 3-1 
summarize the algorithms used to solve for the maximum likelihood estimate of the 
acoustic beacon's position. Both algorithms require that the user specify the maximum 
range and depth of the search area, and an initial guess of the acoustic beacon's 
location. For the case of the moving beacon, the user must also specify the maximum 
allowed velocity of the acoustic beacon. 

Monte Carlo simulations were conducted for several different positions and 
velocities of the acoustic beacon. It was assumed that the receiving ship followed a 
hexagonal search path with legs of 1000 meters. In practice, the actual search path is 
not critical as long as it is not linear. In chapter IV results from six scenarios were 
presented. Overall, the algorithms developed in chapters II and III performed well for 
these scenarios. For a stationary acoustic beacon, good estimates of the acoustic 
beacon’s location were obtain using GPS errors of 3 meters and 25 meters rms. For 
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the moving acoustic beacon, a good estimate of the acoustic beacon's location was 
obtained when using GPS errors of 3 meters rms. However, the accuracy of the 
algorithm used to estimate the moving acoustic beacon's location degrades for GPS 
errors of 25 meters rms unless a large number of experiment vectors are used, or a 
large effective sensor spacing is used. 

From the results of the Monte Carlo simulations, it was shown that, in general, 
as the number of experiment vectors (w M ) used in the maximum likelihood estimation 
problem increased, or the effective sensor spacing increased, the accuracy of the 
estimated beacon location improved. It was also shown that the accuracy of the 
estimated beacon location improved if the receiving ship passed through a closest point 
of approach to the acoustic beacon. In all cases, the accuracy of the estimated beacon 
position was significantly better when using 3 meter GPS errors. This shows that to 
obtain a better estimate of the acoustic beacon's location, the position of the receiving 
ship must be measured accurately. 

For all scenarios, the variance of the estimated beacon position and velocity 
decreased as the number of experiment vectors used increased, or the effective sensor 
spacing increased. It was found that the variance of the moving beacon's estimated 
position was much greater then the variance of the stationary beacon's estimated 
position. This is due the manner in which the acoustic beacon's initial position and 
velocity are combined in the modified structural model. In the modified structural 
model given by equation 3-10, the individual velocity components are added to the 
initial beacon coordinates x 0 , y 0 , and z 0 to find the location of the acoustic beacon 
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when it transmits a signal. As a result, the algorithm estimates the value of the sum of 
the initial position coordinates and the velocities better then the individual components. 
Consequently, the algorithm can not discern between small perturbations in the 
estimated position coordinates and the estimated velocities. 

From these results, to obtain the best possible estimate of the acoustic beacon's 
position a large number of experiment vectors with a large effective sensor spacing 
must be used. However, the time required to collect the measurement vectors 
increases with both the number of experiment vectors and the effective sensor spacing. 
If the time it takes to obtain an estimate of the acoustic beacon's position is an issue, 
fewer experiment vectors and smaller effective sensor spacings can be used. For the 
hexagonal search path shown in figure 4-1, and a pulse repetition interval of 2 
seconds, a minimum of 20 experiment vectors with an effective sensor spacing of 35 
pulse repetition intervals are required to obtain a decent estimate of the acoustic 
beacon's position for a stationary beacon. For the moving beacon, assuming the same 
search path, a minimum of 30 experiment vectors with an effective sensor spacing of 
45 pulse repetition intervals are required. 

In chapter V design specifications for a receiver to implement the algorithms 
given in chapters II and III were developed. The synchronous time of receipt was 
measured by determining the time of arrival of the acoustic beacon's envelope. To 
determine the arrival time of the acoustic beacon's envelop, the beacon's carrier 
frequency was first removed using a precision rectifier with a low pass filter to form 
an envelope detector. The output of the envelope detector was then logarithmically 
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compressed to increase the dynamic resolution of the receiver. Next, the output of the 
logarithmic compressor was digitally sampled using a 68HC11 microcontroller. 
Following A/D conversion, the sampled envelope was passed through a digital 
matched filtered. For a rectangular windowing function, this produces a unique 
maximum output which was used to determine the time of arrival. Following the 
design specifications, a receiver was built from commonly available components. 
Experiments conducted on receiver showed that the test receiver met the design 
specifications of section 5.2. 
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Appendix 1 



This appendix contains the schematic diagrams for the receiver designed in 
chapter V. 
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68HC11 
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Power Supply 




Appendix 2 



This appendix contains the source code used by the 68HC11. The code is 
based on a full function SAIL driver written by Dr. Albert Bradley and operates under 
serial communication interrupt control. The sampling rate of the A/D converter is set 
by using a Timer Output Compare function. After the microcontroller finishes an 
initialization period, it sits in a wait state until a serial communications interrupt or a 
timer output compare interrupt occurs. Once the interrupt is received, the 
microcontroller executes the requested task, and then returns to the wait state. 

; #PTR Driver 

;THE MINIMUM POWER DRAIN IS- 
; 2.5 MA IF IN WAIT LOOP, 4.91 52 MHZ 

6-7 MA IF WORKING, NO LOADS 



**************************************************************************** 



Mon, Sep 17, 1990, 19:21 MINOR CLEANUPS 
IT CONTAINS- 

-?M AND !M ARE OPTIONAL DEPENDING ON THE 'BIG* FLAG 
-FULL BAUD SWITCH CAPABILITY 
-FULL USE OF EVEN PARITY 
-FULL TTY HANDLES 



**************************************************************************** 



PROC "68HC11" 

; THIS IS THE CONTROL FOR THE CONDITIONAL ASSEMBLY OF THE !M AND ?M 
SECTIONS 

= 1 WILL INCLUDE THEM 

=0 WILL EXCLUDE THEM (SAVES $118 BYTES OF CODE) 

LOAD: EQU 1 

VIEW: EQU 1 



**************************************************************************** 

y 



; DEFAULT PARAMETERS 



SAMPLE: EQU $07D1 

RADBUFF: EQU $3000 

ADBFULL: EQU $300B 

MAXBUF1: EQU $3100 

MAXBUF2: EQU $3200 



DBAUD: EQU $30 



;START UP AT 9600 BAUD WITH 8.0 MHZ XTAL 
;1.0mSEC SAMPLING RATE (ADJUSTED FOR ERRORS) 
LOCATION OF RUNNING A/D BUFFER 
;A/D BUFFER FULL AT 1 1 VALUES (0-10) 

;LOCATION OF BUFFER 1 
•.LOCATION OF BUFFER 2 
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ATTNINC: 

ATTNDEC: 

MAX1FL: 

MAX2FL: 



EQU $E8 
EQU $40 
EQU $31 OF 
EQU $320F 



; ATTENUATOR LEVELS 



DBOO 

DB03 

DB09 

DB12 

DB18 

DB24 

DB30 



DMAXNUM: 

DPERIOD: 

DWIND: 



EQU $01 
EQU $09 
EQU $11 
EQU $19 
EQU $21 
EQU $81 
EQU $B9 



EQU 

EQU 

EQU 



$02 

$07D0 

$0014 



INCREASE ATTN AT 4.75 VOLTS 
INCREASE THE PREAMP GAIN AT THIS LEVEL 
CHECK VALUE TO INITIALIZE MAX BUFFER 
CHECK VALUE TO INITIALIZE MAX BUFFER 



0 DB ATTEN 
3 DB ATTEN 
9 DB ATTEN 
12 DB ATTEN 
18 DB ATTEN 
24 DB ATTEN 
30 DB ATTEN 

DEFAULT NUMBER OF MAX POINTS TAKEN 
DEFAULT TO 2 SECOND PERIOD 
DEFAULT INDEX WINDOW 



.************************************t*************************************** 



RP: 


EQU 


$0000 


PORTA 


EQU 


RP+$00 


PORTC 


EQU 


RP+$03 


PORTB 


EQU 


RP+$04 


DDRC: 


EQU 


RP+$07 


PORTD 


EQU 


RP+$08 


DDRD: 


EQU 


RP+$09 


PORTE: 


EQU 


RP+$0A 


» 

CFORC 


: EQU 


RP+$0B 


OC1M: 


EQU 


RP+$0C 


OC1D: 


EQU 


RP+$0D 


TCNT: 


EQU 


RP+$0E 


DTIC1: 


EQU 


RP+$ 1 0 


DTIC2: 


EQU 


RP+$ 1 2 


DTIC3: 


EQU 


RP+$ 1 4 


DTOC1 


EQU 


RP+$ 1 6 


DTOC2 


EQU 


RP+$ 1 8 


DTOC3 


EQU 


RP+$ 1 A 


DTOC4 


EQU 


RP+$ 1 C 


DTOC5 


EQU 


RP+$1E 


TCTL1: 


EQU 


RP+$20 


TCTL2: 


EQU 


RP+$21 


TMSK1 


: EQU 


RP+$22 


TFLG1: 


EQU 


RP+$23 


TMSK2 


: EQU 


RP+$24 


TFLG2: 


EQU 


RP+$25 


PACTL: 


EQU 


RP+$26 


PACNT: EQU 


RP+$27 


SPCR: 


EQU 


RP+$28 


SPSR: 


EQU 


RP+$29 



REGISTER PAGE ON BASE PAGE 
|0C1.0C2.0C3.0C4!0C5.IC1.IC2.IC3| 



|X.X.SS.SCK!MOSI.MISO.TXD.RXD| 

|V7.V6.V5.V4!X.X.X.BRK| 

BAT.BAUD. 

TIMER COMPARE FORCE REGISTER 
OUT COMP 1 MASK REG 
OUT COMP 1 DATA REG 
TIMER REGISTER (HIGH BYTE) 

TIMER INPUT CAPTURE 1 (HI BYTE) 
TIMER INPUT CAPTURE 2 (HI BYTE) 
TIMER INPUT CAPTURE 3 (HI BYTE) 
TIMER OUTPUT COMPARE 1 (HI BYTE) 
TIMER OUTPUT COMPARE 2 (HI BYTE) 
TIMER OUTPUT COMPARE 3 (HI BYTE) 
TIMER OUTPUT COMPARE 4 (HI BYTE) 
TIMER OUTPUT COMPARE 5 (HI BYTE) 
TIMER CONTROL REG 1 
TIMER CONTROL REG 2 
TIMER INTERRUPT MASK REG 1 
TIMER INTERRUPT FLAG REG 1 
TIMER INTERRUPT MASK REG 2 
TIMER INTERRUPT FLAG REG 2 
PULSE ACCUMULATOR CONTROL REG 
PULSE ACCUMULATOR COUNT REG 
SPI CONTROL REGISTER 
SPI STATUS REGISTER 
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SPDR: 


EQU 


RP+S2A 


BAUD: 


EQU 


RP+$2B 


SCCR1 : 


EQU 


RP+S2C 


SCCR2: 


EQU 


RP+S2D 


SCSR: 


EQU 


RP+S2E 


SCDR: 


EQU 


RP+S2F 


ADCTL: 


EQU 


RP+S30 


ADR1: 


EQU 


RP+S3 1 


ADR2: 


EQU 


RP+S32 


ADR3: 


EQU 


RP+S33 


ADR4: 


EQU 


RP+S34 


OPTION: 


EQU 


RP+S39 


HPRIO: 


EQU 


RP+$3C 


INIT: 


EQU 


RP+S3D 


> 

.ft*****************************! 


; SAIL inteface RAM workspace 


RJUMP: 


EQU 


$40 


RVECT: 


EQU 


$41 


» 




$42 


XJUMP: 


EQU 


$43 


XVECT: 


EQU 


$44 


> 




$45 


JUMP2: 


EQU 


$46 


VECT2: 


EQU 


$47 


» 




$48 


SCRTCH1: 


EQU 


$49 


SCRTCH2: 


EQU 


$4A 


SCRTCH3: 


EQU 


$4B 


SCRTCH4: 


EQU 


$4C 


SCRTCH5: 


EQU 


$4D 


XTTY: 


EQU 


$4E 


> 




$4F 


******************************* 

y 


; PTR Data inteface RAM workspace 


PERINDX: 


EQU 


$50 


; 




$51 


PERIOD: 


EQU 


$52 


*, 




$53 


MAXBUFF: 


EQU 


$54 


> 




$55 


MAXFULL: 


EQU 


$56 


> 




$57 


ADBFPTR: 


EQU 


$58 


» 




$59 


TXBUFF: 


EQU 


$5A 


> 




$5B 


TXBFULL: 


EQU 


$5C 



;SPI DATA REGISTER 



;[RAM3.2.1.0!REG3. 2.1.0] 

;JUMP INST GOES HERE.. 

HI 

LO 

;XMIT JUMP INST 
HI 
LO 

;2ND JUMP INST 
HI 

; LO 

SCRATCH LOC 1 
; SCRATCH LOC 2 
;SCRATCH LOC 3 
;SCRATCH LOC 4 
;SCRATCH LOC 5 

;TTY POINTER HI 
LOW 

*********************************** 

;PERIOD TIMER INDEX HI 
LOW 

.LENGTH OF PERIOD HI 
LOW 

;MAXIMUMS BUFFER LOCATION HI 
LOW 

;MAX BUFFER FULL LOCATION HI 
LOW 

;RUNNING A/D BUFFER LOCATION HI 
LOW 

;MAXIMUMS BUFFER TO TX HI 
LOW 

;TX BUFFER FULL LOCATION HI 



* 




$5D 


LOW 


TXIFLG: 


EQU 


$5E 


.FIRST MAXIMUMS SENT FLAG 


TX2FLG: 


EQU 


$5F 


.SECOND MAXIMUMS SENT FLAG 


MAXFLG: 


EQU 


$60 


WHICH MAXIMUM BUFFER TO SAVE FLAG 


AGCFLG: 


EQU 


$61 


MANUAL GAIN CONTROL FLAG 


BIG: 


EQU 


$62 


LARGEST A/D VALUE PER PERIOD LOCATION 


MAXNUM: 


EQU 


$63 


NUMBER OF MAXIMUMS LOCATION 


TXMHI: 


EQU 


$64 


TRANSMIT OUT BUFFERS 


TXMLO: 


EQU 


$65 




TXIHI: 


EQU 


$66 




TXILO: 


EQU 


$67 




TXINT: 


EQU 


$68 


INTERM STORAGE FOR TX POINTER 


TEMPIND: 


EQU 


$70 


INTERM STORAGE FOR MAXIMUM INDEX 


TEMPMAX: 


EQU 


$72 


INTERM STORAGE FOR MAXIMUM 


WINDOW: 


EQU 


$74 


MAXIMUM CHECK WINDOW SIZE 


WINCHK: 


EQU 


$76 


USED FOR TESTING IF WITHIN WINDOW 


INDXCHK: 


EQU 


$78 




> 

.********************************************************************** 


ORG 


$E800 


;ASSUME 27C64 EPROM 


; SAIL Address stored here.. 




ADDR: 


FCB 


"#PTR" 


.SAIL ADDRESS 




FCB 


$00 


.TERMINATOR 


********************************************************************** 

y 


START: 


SEI 








CLR 


$103D 


MOVE REGISTERS TO BASE PAGE (00-> INIT) 




LDS 


#$00FF 


SET STACK POINTER 




LDAA 


#DBAUD 


SET DEFAULT BAUD 




ST A A 


BAUD 






CLR 


SCCR1 


,8 DATA BITS, WAKE ON IDLE? 




LDAA 


#$2C 


.ONLY REC INTERRUPTS YET 




ST A A 


SCCR2 




********************************************************************** 


; PTR TIMER INTERUPT INITIALIZATION 




LDAA 


#$40 


;TOGGLE OC2 ON EACH COMPARE 




ST A A 


TCTL1 






CLR 


TMSK2 


,SET PRESCALE TO /I 




LDAA 


#$90 


.TURN ON THE A/D CONVERTER 




ST A A 


OPTION 






LDAA 


#$20 


USE PEO FOR A/D INPUT, SINGLE CHANNEL, 




ST A A 


ADCTL 


CONTINUOUS SAMPLING 




LDAA 


#$88 


SET PORT A PINS 7 AS OUTPUT 




ST A A 


PACTL 






CLR 


MAXFLG 


INITIALIZE TO FIRST MAXIMUMS BUFFER 




CLR 


TXIFLG 


INITIALIZE TO NOT TXD 




CLR 


TX2FLG 


INITIALIZE TO NOT TXD 




CLR 


AGCFLG 


INITIALIZE TO AGC ON 




CLR 


BIG 


INITIALIZE THE LARGEST VALUE TO ZERO. 




CLR 


TXMHI 


.CLEAR THE OUTGOING BUFFERS 
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CLR 


TXMLO 






CLR 


TXIHI 






CLR 


TXILO 






LDAA 


#DB00 


;SET 0 DB OF ATTENUATION 




ST A A 


PORTA 






LDD 


#RADBUFF 


;SET A/D DATA BUFFER LOCATION IN BASE PAGE 




STD 


ADBFPTR 






LDX 


#MAXBUF1 


;SET FIRST MAX BUFFER LOCATION IN BASE PAGE 




STX 


MAXBUFF 






STX 


TXBUFF 






LDAB 


#DMAXNUM 






ADDB 


#DMAXNUM 






STAB 

ABX 


MAXNUM 


;SET THE NUM MAX CHECK VALUE 




STX 


MAXFULL 


;SET BUFFER FULL TO 2xDMAXNUM 




STX 


TXBFULL 






LDD 


#DPERIOD 


;SET THE PERIOD SIZE 




STD 


PERIOD 






LDX 


#$0000 






STX 


PERINDX 


■.INITIALIZE PERIOD TIMER TO ZERO 




LDAA 


#$00 






LDX 


ADBFPTR 




CLRAD: 


ST A A 
INX 


$00,X 


.CLEAR THE RUNNING A/D BUFFER 




CPX 


#ADBFULL 






BLO 


CLRAD 






LDX 


#MAXBUF1 


.CLEAR THE FIRST MAXIMUM BUFFER 


CLMX1: 


STAA 

rNX 


$00,X 






CPX 


#MAX1FL 






BLS 


CLMX1 






LDX 


#MAXBUF2 


.CLEAR THE SECOND MAXIMUM BUFFER 


CLMX2: 


STAA 

INX 


$00,X 






CPX 


#MAX2FL 






BLS 


CLMX2 






LDD 


#DWIND 


;SET DEFAULT INDEX WINDOW 




STD 


WINDOW 




******* 

y 


*************************************************************** 




CLR 


SCRTCHI 


;USE AS SAIL MODE FLAG & ADDR POINTER 




LDAA 


#$7E 


;MUST WRITE JMP INSTS. 




STAA 


RJUMP 


-.INTO SAIL WORK AREA 




STAA 


XJUMP 






STAA 


JUMP2 






LDD 


#SETUNAD 


;SET VECTORS TO INITIAL VALUES 




STD 


RVECT 






STD 


XVECT 






CLI 




;AND FINALLY ALLOW INTERRUPTS 


> 

********************************************************************** 



163 



********************************************************************** 

> 

; MAIN PROGRAM BODY 

LOOP: WAI ;WAIT TILL INTERRUPTED- 

BRA LOOP 

.********************************************************************** 

********************************************************************** 



TIMER INTERUPT HANDLER 
Fri, Jul 10, 1992, 13:02 
Wed, Jul 22, 1992, 8:35 
Fri, Apr 23, 1993, 9:12 
Thu, May 20, 1993, 1:52 PM 



OC2: 



Til: 



TI2: 



SUMMING: 



LDD 


DTOC2 


GET LAST VALUE IN TOC2 


ADDD 


# SAMPLE 


AND ADD ONE PERIOD TO IT 


STD 


DTOC2 


STORE BACK IN TOC2 


LDAA 


#$FF 


.NORMALIZE THE A/D VALUE 


SUBA 


ADR1 




CMPA 


BIG 


,IS A/D VALUE GREATER THEN BIG? 


BLO 


Til 


,IF IT IS STORE IN BIG ELSE MOVE ON 


ST A A 


BIG 




LDX 


ADBFPTR 


GET THE CURRENT A/D POSITION 


STAA 


$00,X 


STORE THE VALUE 


INX 




UPDATE THE POINTER 


CPX 


#ADBFULL 


CHECK IF AT LAST A/D STORAGE LOCATION 


BLO 


TI2 


IF NOT INC ADBPTR AND MOVE ON 


LDX 


flRADBUFF 


IF YES REINITIALIZE ADBPTR AND MOVE ON 


STX 


ADBFPTR 


SAVE THE A/D STORAGE POINTER 


LDX 


tfRADBUFF 


GET THE A/D BUFFER LOCATION 


LDY 


#$0000 


INITIALIZE THE SUMATION VALUE 


LDAB 


$00,X 


GET THE A/D VALUE TO ADD 


ABY 




SUM=SUM+A/D 


INX 




CONTINUE UNTIL ALL VALUES IN THE A/D 


CPX 


flADBFULL 


BUFFER ARE SUMMED 


BLO 


SUMMING 




LDX 


MAXBUFF 


.GET THE BUFFER TO WRITE TO 


LDD 


PERINDX 


.SETUP FOR TESTING MAX VALUES 


STD 


TEMPIND 




CPD 


WINDOW 


SEE IF THE MAX IS CLOSE TO THE START OF 






THE PERIOD 


BHI 


TI1_1_1 


IF NOT MOVE ON, OTHERWISE 


CPY 


$00 ,x 


CHECK FOR A NEW MAXIMUM 


BLO 


TI12 


IF NOT GOTO CHECK FOR SECONDARY MAX'S 


STY 


$oo,x 


IF YES JUST REPLACE CURRENT MAX 


LDD 


TEMPIND 




STD 


$10,X 




BRA 


TIENDJ 
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TI1_1_1: 


ADDD 


WINDOW ;SEE IF THE MAX IS CLOSE TO THE END OF PERIOD 




CPD 


PERIOD 






BLO 


TI 1_1_2 


IF NOT MOVE ON, OTHERWISE 




CPY 


$oo,x 


CHECK FOR A NEW MAXIMUM 




BLO 


TI1_2 


IF NOT GOTO CHECK FOR SECONDARY MAX'S 




STY 


$00, X 


IF YES JUST REPLACE CURRENT MAX 




LDD 


TEMPIND 






STD 


$10,X 






BRA 


TIENDJ 




TI1_1_2: 


LDD 


PERINDX 






SUBD 


WINDOW 






STD 


WINCHK 






CPY 


$00,X 


CHECK FOR A NEW MAXIMUM 




BLO 


TI 1 _2 


IF NOT CHECK FOR SECONDARY MAX’S 




CPD 


$10,X 


CHECK IF WITHIN WINDOW 




BHI 


TI 1_1 


IF NO REPLACE ALL MAX’S 




STY 


$oo,x 


IF YES JUST REPLACE CURRENT MAX 




LDD 


TEMPIND 






STD 


$10,X 




TIENDJ: 


BRA 


TIEND 




Till : 


LDD 


$00, X 


.SHIFT ALL OLD MAX'S ONE LOCATION AND 




STY 


$00, X 


;SAVE THE NEW MAX VALUE 




STD 


TEMPMAX 






LDY 


$10,X 


;SHIFT THE INDICIES 




LDD 


TEMPIND 






STD 


$10,X 






STY 


TEMPIND 






LDY 


TEMPMAX 






INX 




INCREMENT TO THE NEXT MAX 




INX 








CPX 


MAXFULL 


.SEE IF DONE 




BLO 


TI1_1 






BRA 


TIEND 




y 

TI1_2: 


LDD 


$10,X 


;CHECK FOR SECONDARY MAX'S 




ADDD 


WINDOW 


;SET UP INDEX WINDOW 




STD 


INDXCHK 






INX 




;MOVE TO THE NEXT MAX 




INX 








CPX 


MAXFULL 


;SEE IF DONE 




BHS 


TIEND 






CPY 


$oo,x 


.LOOK FOR NEW SECONDARY 




BLO 


TI I _2 






LDD 


TEMPIND 






CPD 


INDXCHK 


;IF WITHIN THE WINDOW OF THE LARGER MAX 




BLO 


TIEND 


.IGNORE THE VALUE 




LDD 


PERIOD 






SUBD 


PERINDX 
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CPD 


WINDOW 






BLO 


TIEND 


;IF ON THE SCREEN WRAP IN WINDOW IGNORE 


* 


LDD 


PERINDX 






SUBD 


WINDOW 






CPD 


$10,X 


;IF WITHIN THE WINDOW OF THE SECONDARY 




BHI 


TI1_3 






STY 


$00 ,X 


;JUST REPLACE THE ONE VALUE 




LDD 


PERINDX 






STD 


$10,X 






BRA 


TIEND 




* 

TI13: 


LDD 


$00, X 


.ELSE REPLACE AND SHIFT OLD VALUES DOWN 




STY 


$oo,x 






STD 


TEMPMAX 






LDY 


$10,X 






LDD 


TEMPIND 






STD 


$10,X 






STY 


TEMPIND 






LDY 


TEMPMAX 






INX 








INX 








CPX 


MAXFULL 






BLO 


TI13 




TIEND: 


LDX 


PERINDX 


;GET THE PERIOD COUNTER AND INCREMENT 




INX 








CPX 


PERIOD 


;IS THE PERIOD COMPLETED? 




BLO 


Till 




> 


INC 


MAXFLG 






BRCLR 


MAXFLG,$01,TI7 ;ARE WE IN MAXIMUMS BUFFER 1 OR 2? 




CLR 


TX1FLG 


.CLEAR BUFFER 1 TX’D FLAG 




LDY 


#MAXBUF2 






BRA 


TI8 




TI7: 


CLR 


TX2FLG 


•.CLEAR BUFFER 2 TX’D FLAG 




LDY 


#MAXBUF1 




TI8: 


STY 


MAXBUFF 


.UPDATE THE BUFFER TO USE 




LDAB 


MAXNUM 






ABY 








STY 


MAXFULL 


.UPDATE THE FULL BUFFER VALUE 


> 


BRSET 


AGCFLG,$0 1 ,TI 1 0 ;IF MANUAL GAIN SET DON'T CHECK AGC 




LDAA 


BIG 


;TEST IF GAIN NEEDS TO BE DECREASED 




CMPA 


#ATTNINC 


;IF NOT MOVE ON 




BLO 


TI9 






JSR 


ATTN 


;GO TO ATTN FOR MORE ATTENUATION 




BRA 


TI10 




TI9: 


CMPA 


#ATTNDEC 


.TEST IF GAIN NEEDS TO BE INCREASED 




BHI 


TI10 


;IF NOT MOVE ON 




JSR 


INC 


;GO TO INC FOR LESS ATTENUATION 
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TI10: 


CLR 


BIG 


;RESET BIG FOR NEXT PERIOD 


9 


LDX 


#$0000 


;CLF.AR THE PERIOD COUNTER 


Till: 


STX 


PERINDX 






LDAA 


#$40 


.RESET TIMER FLAGS 




STAA 

RTI 


TFLG1 





.*++******+*+***********++*++***+++**++***+***+****+*+++*+*** 

; SCI INTERRUPT HANDLER (SAIL DRIVER) 

; Sat, May 12, 1990, 20:34 COMPACT BY 20 BYTES BY USING RSET: 

; Sun, May 13, 1990, 12:36 COMPACT BY USING CONDITIONAL ASSEMBLY 

Sun, May 13, 1990, 12:37 AND BY USING TTY FOR PROMPT 
Mon, Sep 17, 1990, 19:20 ADD IN4 TO TTY 
SCI: BRCLR SCSR,$0E,CKCHAR ;TEST FOR VALID CHAR 



;& 


LDAA 


SC SR 


.TEST OR.NF.FE 




ANDA 


#$0E 






BEQ 


CKCHAR 


IF GOOD, GO ON.. 




LDAA 


SC DR 


READ BAD CHAR TO CLEAR? 


ECHO: 


NOP 




RECEIVE AN ECHO CHARACTER (& IGNORE!) 


SCIXIT: 

9 


RTI 




& EXIT 


CKCHAR: 


BRSET 


SCSR, $20, READD 


;& 


LDAA 


SCSR 


.TEST DA 


9 


ANDA 


#$20 




9 


BNE 


READD 






JMP 


CHECKX 


,IF NOT, XMIT 


9 

READD: 


LDAA 


SC DR 


READ DATA TO A.. 




TAB 




AND COPY TO B 




LDX 


#PARITY 


POINT PARITY TABLE 




ABX 




POINT INTO PARITY TABLE 




LDAB 


o,x 


GET PARITY WORD 




BNE 


SCIXIT 


REJECT IF NOT EVEN PARITY 




ANDA 


#$7F 


ELSE REMOVE PARITY FOR SUBSEQUENT TESTS 




TAB 




(ALSO COPY TO B) 




CMPA 


#'#’ 


IS IT '#'? 




BEQ 


GOTNUM 






JMP 


RJUMP 


;ELSE GO THRU VECTOR 


ATXIT: 


.IMP 


SCIXIT 


NO FURTHER USE FOR THIS CHAR, EXIT 


9 

; SAIL ADDRESS RECOGNIZE SECTION 


GOTNUM: 


LDAB 


#01 


GOT # CODE 




STAB 


SCRTCH1 


SET SAIL FLAG TO 01 




BCLR 


SCCR2,$D2 


TURN OFF XMIT INTERRUPTS 


;& 


LDAA 


SCCR2 






ANDA 


#$2C 


;TURN OFF XMIT INTERRUPTS 




STAA 


SCCR2 






LDD 


#READAD 


.POINT READ ADDRESS 
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RSET: 


STD 


RVECT 


..MAY ENTER HERE FROM MANY OTHER PLACES 




JMP 


SCIXIT 


AND EXIT 


> 

READAD: 


LDAB 


SCRTCH1 


GET SMODE COUNT 




CMPB 


#$01 


IS THIS THE FIRST CHAR? 




BNE 


TRYADD 






CMPA 


#'0' 


IF FIRST, IS IT 'O'? 




BEQ 


TSTBAUD 


IF SO, MAY BE BAUD SWITCH 


> 






CONTINUE ON BELOW... 


TRYADD: 


LDX 


#ADDR 


;ELSE POINT X TO ADDR 




ABX 




ADD TO X 




CMPA 


o,x 


COMPARE NEW CHAR TO A 




BEQ 


NEXTAD 


IF MATCH, LOOK FOR NEXT IN LIST 


» 

SETUNAD: 


LDD 


#UNADDR 


ELSE SET UNADDRESS STATE 




STD 


RVECT 




UNADDR: 


CLR 


SCRTCH1 


.CLEAR SAIL MODE TO 00 




BCLR 


SCCR2,$D2 


TURN OFF XMIT INTERRUPTS 


;& 


LDAA 


SCCR2 






ANDA 


#$2C 


TURN OFF XMIT INTERRUPTS 




STAA 


SCCR2 






LDD 


#XPASS 


SET XMIT VECTOR TO PASS 


XSET: 


STD 


XVECT 






JMP 


SCIXIT 




NEXTAD: 


INX 




POINT NEXT ADD CHAR 




INC 


SCRTCH1 


(& INC COUNTER) 




TST 


0,X 


TEST IT, 




BEQ 


GOTADDR 


TERMINATOR? 




JMP 


SCIXIT 


ELSE SAME VECTOR 


> 

GOTADDR: 


LDD 


#CONCHAR 


,REC CONTROL CHAR NEXT.. 




JMP 


RSET 




* 

; TEST FOR BAUD CHANGE COMMAND 


TSTBAUD: 


LDD 


#BAUD2 






JMP 


RSET 




> 

BAUD2: 


CMPA 


#' O' 


;GOT SECOND 0? 




BEQ 


BAUD3 






JMP 


SETUNAD 




9 

; COME HERE IF GOT 


#00 (BAUD CHANGE) 


BAUD3: 


LDX 


#SCRTCH1 


;POINT TO 5 CHAR BUFFER 




STX 


VECT2 


,SAVE AT VECT2 




LDD 


#BAUD4 






JMP 


RSET 




BAUD4: 


LDX 


VECT2 


;GET POINTER 




CMPA 


W ' 


;IS IT SPACE? 
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BNE 


BAUD5 






LDAA 


ro’ 


..CHANGE SPACES TO 0'S 


BAUDS: 


ST A A 


0,x 


STORE CHAR 




INX 


;ADVANCE POINTER 




CPX 


#SCRTCHl+5 


PAST END OF 5 CHAR BUFFER? 




BEQ 


BAUD6 






STX 


VECT2 


IF NOT DONE, SAVE POINTER 




JMP 


SCIXIT 


AND GET MORE 


BAUD6: 


LDX 


SCRTCH1+3 


GET LAST TWO CHARS 




CPX 


#$3030 


ARE LAST TWO CHARS BOTH 0? 




BNE 


WAITBRK 


IF NOT VALID, SET UP TO WAIT FOR BREAK 


* 

; IF LAST TWO CHARS ARE 00, CHECK BUFFER AGAINST DATA TABLES FOR A MATCH 




LDD 


#BAUDTBL 


SET UP TABLE POINTER 




STD 


VECT2 


AND STORE IN JUMP2 VECTOR 


* 

; TRY EACH TABLE SEPARATELY, 00 AS 1ST CHAR SIGNALS END OF TABLE 


BTRY: 


LDX 


VECT2 


GET TABLE POINTER 




LDAA 


o,x 


AND TABLE ELEMENT 




BEQ 


WAITBRK 


IF=00, WAS NO MATCH, WAIT FOR BREAK 


; COMPARE BUFFER 


WITH ONE TABLE ENTRY 




LDX 


#SCRTCH1 


;INIT BUFFER POINTER TO TOP 




STX 


XVECT 


; & SAVE IN XMIT JUMP VECTOR 


; COMPARE EACH CHARACTER 




COMPARE: 


LDX 


XVECT 


GET BUFFER POINTER 




LDAA 


o,x 


TO GET BUFFER CHAR TO A 




INX 




INX BUF POINT WHILE WE'RE HERE 




STX 


XVECT 


& SAVE.. 




LDX 


VECT2 


NOW GET TABLE POINTER 




CMPA 


0,X 


& USE TO COMPARE CHARS 




BNE 


NOMATCH 




CMATCH: 


INX 




IF MATCH, MOVE AHEAD TABLE POINTER 




LDAA 


0,X 


LOOK AT NEXT TABLE ELEMENT 




BEQ 


MATCH 


IF IT’S 00, FULL MATCH! 




STX 


VECT2 


ELSE SAVE TABLE POINTER 




BRA 


COMPARE 


AND TRY NEXT CHAR 


NOMATCH: 


INX 




INC TABLE POINTER 




LDAA 


0,X 


AND LOOK FOR 00 




BNE 


NOMATCH 


LOOP TILL IT'S FOUND 




INX 




INC OVER NULL 




INX 




& BAUD SET BYTE 




STX 


VECT2 


AND REPLACE TO HOLDING LOCATION 




BRA 


BTRY 


GO BACK TO CHECK NEXT TABLE 


* 

WAITBRK: 


LDAA 


me 


TURN OFF SCI INTERRUPTS 




STAA 


SCCR2 


(REQUIRES TOF INTERRUPT TO RESTART) 




JMP 


SETUNAD 


AND SET VECTORS FOR NEW ADDRESS.. 
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;*BAUD* ALL LINES WITH THIS ITEM ARE MODIFIED FOR EACH BAUD GROUP 
; MATCH TABLE FOR BAUD RATE SWITCH 



BAUDTBL: 


FCB 


'096',$00,$30 


; 9600 


♦BAUD* 




FCB 


ws'.soo.sji 


; 4800 BAUD 


♦BAUD* 




FCB 


'024',$00,$32 


; 2400 


♦BAUD* 




FCB 


'012',$00 > $33 


; 1200 


♦BAUD* 




FCB 


'006\$00,$34 


; 600 


♦BAUD* 




FCB 


’003’, $00, $35 


; 300 


♦BAUD* 




FCB 


$00 


;DONE 




MATCH: 


INX 




;PASS 00 TERMINATOR 






LDAA 


o,x 


;GET BAUD BYTE 






STAA 


BAUD 


;AND RE-WRITE 






JMP 


SETUNAD 


;AND PREPARE FOR NEW ADDRESSING 


; ?M COMMAND - DATA INPUT SECTION 






if 


VIEW 






QUERYM: 


LDD 


#SAVEADD 


;NOW INPUT ADDRESS 






JMP 


IN4 






* 

SAVEADD: 


LDD 


SCRTCH1 


;GET ADDRESS, 






STD 


SCRTCH3 


;& SAVE IN ADDRESS POINTER 




LDD 


# STARTL 








JMP 


IN4 


.THEN GET LENGTH 




> 

STARTL: 


LDD 


SCRTCH1 


;IF LENGTH NE 0000 






BNE 


STARTL2 


; CARRY ON.. 






JMP 


PROMPT 


;ELSE QUIT 




* 

STARTL2: 


LDD 


#ECHO 


;PREPARE TO IGNORE ECHO CHARS 




STD 


RVECT 








BSET 


SCCR2,$E0 


;START XMIT INTERRUPTS 




;& 


LDAA 


SCCR2 








ORAA 


#$E0 


;START XMIT INTERRUPTS 






STAA 


SCCR2 








JMP 


OUTLINE 


;& SEND A LINE.. 





; ..THE ?M DUMP IS STORED IN THE XMIT SERVICE SECTION BELOW 
else 
endif 



!M SECTION 





IF 


LOAD 


•.CONDITIONAL ASSEMBLY OF LOAD M SECTION 


BANGM: 


LDD 


#KEEPADD 


; INPUT STARTING ADDRESS 




JMP 


IN 4 




KEEPADD: 


LDD 


#HIHEX 


;WAIT FOR HIGH HEX CHAR 
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JMP 



RSET 



HIHEX: 


JSR 


ASCHEX 




BCS 


TERMIN 




ASLA 






ASLA 






ASLA 






ASLA 






ST A A 


SCRTCH5 




LDD 


#LOWHEX 




JMP 


RSET 


> 

LOWHEX: 


JSR 


ASCHEX 




BCC 


STASH 




JMP 


PROMPT 


STASH: 


LDX 


SCRTCH1 




ORAA 


SCRTCH5 




ST A A 


0.X 




INX 






STX 


SCRTCH1 




LDD 


#HIHEX 




JMP 


RSET 


TERM IN: 


ANDA 


#$7F 




CMPA 


#$0D 




BNE 


TERMIN2 




JMP 


PROMPT 


TERMIN2: 


CMPA 


«• ' 




BNE 


TERMIN3 




LDD 


#HIHEX 




JMP 


RSET 


TERMIN3: 


CMPA 






BNE 


TERMIN4 




LDD 


#BANGM 




BRA 


PASSLF 


* 

TERMIN4: 


CMPA 


#7 




BNE 


TERMIN5 




LDD 


#SETHIHX 


PASSLF: 


STD 


VECT2 




LDD 


#PASSLF2 




JMP 


RSET 


» 

PASSLF2:CMPA 


#$0A 




BNE 


PXIT 




.IMP 


.TUMP2 


PXIT: 


JMP 


SCIXIT 


SETHIHX: 


LDD 


#HIHEX 



.ATTEMPT CONVERT TO HEX 
.CHECK TERMINATOR IF NOT.. 

.MOVE OVER NIBBLE 



.CONVERT LOW 

.PROMPT IF BAD SECOND CHAR 
;GET POINTER 
.COMBINE NIBBLES 
; STORE IT.. 

;INC & 

.RESTORE POINTER 



.MASK OFF FLAG BIT 
;IS IT CR? 



;IS IT SPACE? 



;OR ? 



;OR ? 



;GOT LF YET? 

;IF YES, EXIT THRU .TMP2 
;ELSE WAIT FOR MORE CHARS.. 

;IF 7 THEN PREP FOR MORE HEX 
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JMP 



RSET 



> 

TERMIN5: JMP PROMPT 

endif 



;TO PROMPT IF NOT VALID CHAR 



IN4 HEX DIGITS 

INPUTS HEX DIGITS TILL TERMINATED BY A SPACE OR 
BY A CR. (OR BY UNADDRESS). RESULT LEFT AT SCRTCH1.2 
EXITS THRU JUMP2 WHEN DONE (TARGET IN D ON ENTRY) 



IN4: 



* 

IN4HEX: 



* 

CKEND: 



* 

INEXIT: 



STD 


VECT2 


;STORE EXIT VECTOR 


CLR 


SCRTCH1 


•.CLEAR INPUT BUFFER 


CLR 


SCRTCH2 




LDD 


#IN4HEX 


.POINT CHAR RECEIVER 


JMP 


RSET 




JSR 


ASCHEX 


;CONVERT TO HEX 


BCS 


CKEND 


;IF NOT HEX, CHECK FOR END 


PSHA 




;SAVE.. 


LDAA 


SCRTCH1 


;HI TO A 


LDAB 


SCRTCH2 




ASLD 




•.SHIFT OVER FOUR 


ASLD 






ASLD 






ASLD 






STAA 


SCRTCH1 


.RETURN HIGH 


STAB 


SCRTCH2 


;AND B 


PULA 




.RETRIEVE NEW NIBBLE 


ORAA 


SCRTCH2 


.ADD NEW NIBBLE 


STAA 


SCRTCH2 


; & UPDATE 


JMP 


SCIXIT 




ANDA 


#$7F 


.CLEAN OFF MS FLAG BIT 


CMPA 


#' ' 


;IS IT SPACE? 


BEQ 


INEXIT 




CMPA 


#$0D 


;IS IT CR? 


BEQ 


INEXIT 




JMP 


SCIXIT 


.ELSE, GET ANOTHER CHAR 


JMP 


JUMP2 


;IF DONE, CARRY ON THRU VECTOR. 



INPUT ONE HEX BYTE AND CONTINUE THRU JUMP2 



INBYTE: ASLA 




.MOVE OVER 


ASLA 






ASLA 






ASLA 






STAA 


SCRTCH5 


.SAVE 


LDD 


#INBYTE2 


-.POINT TO NEXT SEGMENT 


.IMP 


RSET 
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INBYTE2: 


JSR 

BCC 


ASCHEX 

SAVEDAT 


;CONVERT LOW NIBBLE 




JMP 


SETUNAD 


;UNADDRESS IF ERROR 


* 

SAVEDAT 


o 

73 

> 

> 


SCRTCH5 


.COMBINE 




.IMP 


JUMP2 


;AND CARRY ON THRU VECTOR2 



; NOW CHECK THE TRANSMIT SITUATION 



CHECKX: 


BRCLR 


SCSR,$80,XERROR 


;& 


LDAA 


SC SR 


;MAKE SURE XMIT BIT WAS SET 


* 


ANDA 


#$80 




’ 


BEQ 


XERROR 






JMP 


XJUMP 


;GO THRU XMIT VECTOR 


> 

; THESE SEGMENTS ARE ENTERED THRU XJUMP AND XVECTOR.. 


XERROR: 


NOP 




;TRIG LOC FOR DIAGNOSTICS 


» 

; XJUMP TARGETS.. 






XPASS: 


BCLR 


SCCR2,$D0 




;& 


LDAA SCCR2 






ANDA #$2F 




* 


ST A A SCCR2 






JMP 


SCIXIT 






if 


VIEW 


;a conditional segment 


; OUTPUT A LINE OF DATA (FROM ?M DUMP) 


OUTLINE: 


LDD 


//OUTLF 


;& SET UP TO XMIT 




STD 


XVECT 






LDAA 


#$0D 


;SEND CR 




JMP 


SETOUT 




* 

OUTLF: 


LDD 


//OUTADDR 






STD 


XVECT 






LDAA 


//$0A 


;SEND LF 




JMP 


SETOUT 




OUTADDR: 


LDD 


//LOWADDR 


;PREP OUTBYTE XIT 




STD 


VECT2 






LDAA 


SCRTCH3 


;GET HIGH ADDRESS 




JMP 


OUTBYTE 




* 

LOWADDR: 


LDD 


//LOWADD2 


.EXIT FROM 2ND OUTBYTE.. 




.IMP 


XSET 




LOWADD2: 


LDD 


//ADDRSP 






STD 


VECT2 






LDAA 


SCRTCH4 


;NOW LOW ADDRESS 




JMP 


OUTBYTE 
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ADDRSP: 


LDD 


#SENDSP 


EXIT FROM 2ND OUTBYTE... 




JMP 


XSET 




SENDSP: 


LDD 


#OUTDATA 






STD 


XVECT 






LDAA 


#$20 


SEND SPACE 




JMP 


SETOUT 




OUTDATA: 


LDX 


SCRTCH3 


GET ADDR POINTER 




LDAA 


0.X 


TO GET DATA BYTE 




PSHA 




SAVE 




LDD 


#DECLEN 






STD 


VECT2 


PREP XIT VECTOR 




PULA 


.RETRIEVE DATA BYTE 




JMP 


OUTBYTE 


,& SEND IT 


> 

DECLEN: 


LDD 


#DECLEN2 


EXIT FROM OUTBYTE2., 




JMP 


XSET 




> 

DECLEN2: 


LDX 


SCRTCH1 


GET LENGTH 




DEX 




DECREMENT 




STX 


SCRTCH1 


& RETURN 




BNE 


SAYMORE 


MORE DATA? 




JMP 


PROMPT 


PROMPT IF DONE 


> 

SAYMORE: 


LDX 


SCRTCH3 


,GET ADDR 




INX 


; INCREMENT 




STX 


SCRTCH3 


REPLACE 




XGDX 




,X REG TO ACCD 




LSRD 


;LSB TO C 




BCS 


OUTDATA 


NEXT BYTE NOW IF ODD 




ANDB 


#$07 .CHECK FOR XXXO (LINE END) 




BNE 


SENDSP 


JF ONLY EVEN, SEND SP 




LDAA 


#';' ; 


JF NEW LINE, SEND CONTINUATION 




JSR 


GENPAR 






STAA 


SCDR 






LDD 


#OUTLINE 


& PREP FOR NEW LINE.. 




.IMP 


XSET 






endif 







; OUTPUTS A BYTE IN A AS TWO HEX CHARS, EXITS VIA VECT2 


OUTBYTE: STAA 


SCRTCH5 


.STASH FOR LATER 


LSRA 






LSRA 




.MOVE OVER 


LSRA 






LSRA 






JSR 


HEXASC 


.CONVERT 


PSHA 




;AND SAVE.. 


LDD 


#OUTBYT2 
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STD XVECT 

PULA ;RECOVER CHARACTER 

JMP SETOUT 

OUTBYT2: LDAA SCRTCH5 

ANDA #$0F ;CLEAN UP 

JSR HEXASC 

JMP OUT JMP ;CONVERT, SEND & JUMP THRU VECT2 



> 

; SEND A PROMPT FROM THE MONITOR, THEN WAIT FOR CHARS 


PROMPT: 


LDX 


#PLIST 






JMP 


TTYO 




PLIST: 


FCB 


$0D,$0 A/:\$EE,$90,SCRTCH 1 ,$AA 




FDB 


PJUMP 




PJUMP: 


LDAA 


SCRTCH1 






JMP 


CONCHAR 




; INITIATE AN OUTPUT SEQUENCE 




SETOUT: 


JSR 


GENPAR 






STAA 


SCDR .SEND FIRST CHAR 




BSET 


SCCR2,$C0 




;& 


LDAA 


SCCR2 




» 


ORAA 


#$C0 ;TURN ON INTERRUPTS IF REQ'D 


* 


STAA 


SCCR2 






LDD 


#ECHO ; 


,& PREPARE TO ECHO 




JMP 


RSET 




; SENDS ETX & CARRIES ON THRU VECT2 


XETX: 


LDAA 


#$03 


SEND ETX 


OUT JMP: 


JSR 


GENPAR 


MAY ENTER HERE... 




STAA 


SCDR 


DRAGON AGAIN? 




JMP 


JUMP2 


NOW THRU JUMP2 


.************************************************************ 


; SUBROUTINES USED BY PTR DRIVER 


ATTN: 


LDAA 


PORTA 


GET THE VALUE IN PORT A 




CMPA 


#DB00 


IS 0 DB SET? 




BNE 


ATTN1 


IF NO GO ON 




LDAA 


#DB03 


IF YES SET 3 DB 




STAA 


PORTA 






BRA 


ATTNF 


EXIT 


ATTN 1 : 


CMPA 


#DB03 


IS 3 DB SET? 




BNE 


ATTN2 


IF NO GO ON 




LDAA 


#DB09 


IF YES SET 9 DB 




STAA 


PORTA 






BRA 


ATTNF 


EXIT 


ATTN2: 


CMPA 


#DB12 


IS 12 DB SET? 




BNE 


ATTN3 


IF NO GO ON 
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LDAA 


#DB18 


;IF YES SET 18 DB 




ST A A 


PORTA 






BRA 


ATTNF 


;EXIT 


ATTN 3: 


CMP A 


#DB18 


;IS 18 DB SET? 




BNE 


ATTN4 


;IF NO GO ON 




LDAA 


#DB24 


;IF YES SET 24 DB 




ST A A 


PORTA 






BRA 


ATTNF 


;EXIT 


ATTN4: 


CMPA 


#DB24 


;IS 24 DB SET? 




BNE 


ATTN5 


;IF NO GO ON 




LDAA 


#DB30 


;IF YES SET 30 DB 




ST A A 


PORTA 






BRA 


ATTNF 


;EXIT 


ATTN 5: 


CMPA 


#DB30 


;IS 30 DB SET? 




BNE 


ATTN6 


;IF NO GO ON 




BRA 


ATTNF 


;IF YES CANT CHANGE ANYMORE 


ATTN6: 


LDAA 


#DB00 


;IF NON OF THE ABOVE ARE SET, SET 0 DB 




ST A A 


PORTA 




ATTNF 


RTS 






INC: 


LDAA 


PORTA 


;GET THE VALUE IN PORT A 




CMPA 


#DB30 


;IS 30 DB SET? 




BNE 


INC] 


;IF NO GO ON 




LDAA 


#DB24 


;IF YES SET 24 DB 




ST A A 


PORTA 






BRA 


INCF 


;EXIT 


INC1: 


CMPA 


#DB24 


;IS 24 DB SET? 




BNE 


INC2 


;IF NO GO ON 




LDAA 


#DB18 


;IF YES SET 18 DB 




STAA 


PORTA 






BRA 


INCF 


;EXIT 


INC2: 


CMPA 


#DB18 


;IS 18 DB SET? 




BNE 


INC3 


;IF NO GO ON 




LDAA 


#DB12 


;IF YES SET 12 DB 




STAA 


PORTA 






BRA 


INCF 


;EXIT 


INC3: 


CMPA 


#DB12 


;IS 12 DB SET? 




BNE 


INC4 


;IF NO GO ON 




LDAA 


#DB09 


;IF YES SET 9 DB 




STAA 


PORTA 






BRA 


INCF 




INC4: 


CMPA 


8DB09 


;IS 9 DB SET? 




BNE 


INC 5 


;IF NO GO ON 




LDAA 


#DB03 


;IF YES SET 3 DB 




STAA 


PORTA 






BRA 


INCF 




INC 5: 


LDAA 


#DB00 


;IF NON OF THE ABOVE ARE SET, SET 0 DB 




STAA 


PORTA 




INCF 


RTS 






.******* 


***************************************************** 
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SUBROUTINES USED BY SAIL DRIVER, 



Converts low nibble in A to ASCII char in A 
HEXASC: 



HNUMBER: 



ANDA 


#$0F 


;CLEAN IT UP 


ADDA 


#$F6 




BCC 


HNUMBER 




ADDA 


#$07 


•.CONVERT 


ADDA 

RTS 


#$3A 


; TO ASCII 



Converts ASCII char in A to nibble in A if it is HEX & clears C 
Otherwise, returns origional char with C bit set. 



ASCHEX: 


PSHA 




;SAVE CHAR 




SUBA 


#$30 






BCS 


NOTHEX 






SUBA 


#$0A 






BGE 


TSTALPH 






ADDA 


#$0A 


;REPAIR NUMB 




BRA 


AXIT 




TSTALPH: 


SUBA 


#$07 


;4 1 ->00 ? 




BLT 


NOTHEX 






SUBA 


#$06 






BGE 


NOTHEX 






ADDA 


#$10 


;REPAIR ALPH 


AXIT: 


INS 




;POP OFF SAVED CHAR 




CLC 




;AND CLEAR CARRY BIT 




RTS 






* 

NOTHEX: 


PULA 




;GET CHAR 




SEC 




;SET CARRY 




RTS 






> 

; GENERATE PARITY- 


Char is passed 


in and out thru A 


GENPAR: 


PSHB 




;SAVE SOME STUFF.. 




PSHX 








TAB 




;COPY CHAR TO B 




LDX 


^PARITY 


;POINT TO PARITY TABLE 




ABX 




;ADD OFFSET TO POINT X 




ORAA 


0,X 


;ADD PARITY BIT 




PULX 




RE STORE 




PULB 








RTS 






; PARITY TABLE 







PARITY: 



; XX20 



FCB $00,$80,$80,$00,$80,$00,$00,$80 
FCB $80,$00,$00,$80,$00,$80,$80,$00 
FCB $80,$00,$00,$80,$00,$80,$80,$00 
FCB $00,$80,$80,$00,$80,$00,$00,$80 



;A 

;B 

;B 

;A 



FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 
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; XX40 



FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

; XX60 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

FCB $80,$00 ) $00 > $80,$00,$80 > $80,$00 ;B 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

; XX80 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

FCB $00 ,$80, $80, $00, $80 ,$00 ,$00 ,$80 ;A 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

; XXAO 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

; XXC0 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;B 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;A 

; XXE0 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;A 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;B 

FCB $00,$80,$80,$00,$80,$00,$00,$80 ;B 

FCB $80,$00,$00,$80,$00,$80,$80,$00 ;A 



; CHARACTER LOOKUP TABLE 

CHARTBL: FCB $4 1 ,$42,$43,$44,$45,$46,$47,$00 ;00-07 

FCB $00,$00,$00,$00,$00,$00,$00,$00 ;08-0F 

FCB $49,$4A,$4B,$4C,$4D,$4E,$50,$00 ;10-17 

FCB $00,$00,$00,$00,$00,$00,$00,$00 ;18-1F 

FCB $51 ,$52,$53,$54,$55,$56,$57,$00 ;20-27 

FCB $00,$00,$00,$00,$00,$00,$00,$00 ;28-2F 

FCB $59,$5A,$5B,$5C,$5D,$5E,$5F,$75 ;30-37 

FCB $00,$00,$00,$00,$00,$00,$00,$00 ;38-3F 

FCB $6 1 ,$62, $63 ,$64,$65,$66,$68,$74 ;40-47 

FCB $00,$00,$00,$00,$00,$00,$00,$00 ;48-4F 

FCB $69,$6A,$6B,$6C,$6D,$6E,$70,$74 ;50-57 

FCB $00,$00,$00,$00,$00,$00,$00,$00 ;58-5F 

FCB $71, $72, $73, $74, $75, $76, $77, $72 ;60-67 

FCB $00,$00,$00,$00,$00,$00,$00,$00 ;68-6F 



**»*****«,*****»*»****»*********«*«************»*****»*»*»** 
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; HELP FILE DUMP 
SAYHELP: LDX flHELPFIL 

BRA TTYO 



A TTY ROUTINE FOR SAIL68 **DO NOT DELETE! USED BY PROMPT ETC!** 

-USES $FD BYTES 

-TO ENTER FOR XMIT, LDX Stable AND THEN JMP TTYO 
-TO ENTER IN REC MODE LDX Stable AND .IMP TTYRO 
-MUST USE EE TO SWITCH FROM SENDING TO REC CHARS 
-CAN GO BACK TO SENDING W/O PROBLEM 
-ARG TABLE CODES.. 

ASCII -TYPE IT AND GO ON WITH XMIT INTERRUPTS ON 
00 -BACK TO THE PROMPT 

AA aaaa -.IMP TO aaaa WITH XMIT INTERRUPTS STILL ON (USE FDB!) 

80 aa -SEND CHAR AT LOC aa 

81 aa -SEND HEX PAIR AT LOC aa 

EE -SEND ETX & WAIT FOR A CHAR (MUST BE FOLLOWED BY 9X) 

90 aa -REC A CHAR AND SAVE IT AT aa 

91 aa -REC A HEX PAIR AND SAVE IT AT aa (ABORT TO PROMPT <>HEX) 
94 aa -CLEAR SCRTCH1.2 & WAIT FOR A HEX STRING, PUT AT aa,aa+l 

(ENTRY TERMINATED BY SP OR CR) 



TTY: 

TTYO: 



LDX 


XTTY 


;LOAD X FROM STORAGE LOCATION 


LDD 


#TTY 


;SET REENTER VECTOR 


STD 


XVECT 




LDAA 


00, X 


;GET ARGUMENT 


BNE 


TRYAA 




JMP 


PROMPT 


;IF =00, GO DIRECTLY TO PROMPT. 



TRYAA: 



CMP A 


#$AA 




BNE 


TRYASC 




INX 






LDX 


0,X 


;VECTOR TO X 


JMP 


0,X 


;AND JUMP TO M(X) 



TRYASC: 


TSTA 

BMI 


TRY80 




JSR 


LBISX 




TBA 






JMP 


SETOUT 



;IF MSB IS 1, NOT ASCII.. 

;ELSE GET THE ASCII IMM CHAR 

;GO SEND IT NOW 



TRY80: 



CMPA 


#$80 


;REQ IND CHAR? 


BNE 


TRY81 




INX 

JSR 


LBISX 


;GET THE ADDRESS (ASSUME BASE PAGE) 


JSR 


CRADDR 


;CREATE ADDRESS 


LDAA 


0,X 


;GET THE IND DATA 


JMP 


SETOUT 





* 

TRY81: 


CMPA 


#$81 




BNE 


TRYEE 



;REQ IND HEX PAIR? 
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INX 








JSR 


LBISX 


;GET THE ADDRESS (ASSUME BASE PAGE) 




JSR 


CRADDR 


.CREATE ADDRESS 




LDD 


#TTY2 


.THEN SET UP VECT2 EXIT PATH 




STD 


VECT2 






LDAA 


0,X 


;GET THE IND DATA NOW 




JMP 


OUTBYTE 




TTY2: 


LDD 


#TTY 


.EXIT PATH FOR VECT2 STUFF.. 




JMP 


XSET 


.(ALLOWS OUTBYTE TO RETURN TO TTY) 


9 

TRYEE: 


CMPA 


#$EE 


;SEND ETX & GO TO RECEIVE MODE? 




BEQ 


GOTEE 




TRERR: 


JMP 


PROMPT 


;IF NOT VALID OUT GROUP CONTROL CHAR, JUST 


PROMPT 








9 

GOTEE: 


INX 




.SWITCH TO INPUT MODE 




STX 


XTTY 


.SAVE THE CONTROL TABLE POINTER 




LDAA 


#$03 


.SEND ETX 




JSR 


GENPAR 






ST A A 


SCDR 






BCLR 


SCCR2,$C0 


.STOP FURTHER XMIT INTERRUPTS 




LDD 


#TTY3 


; AND PREPARE TO RECEIVE THE ETX ECHO 




JMP 


RSET 




9 

TTY3: 


CMPA 


#$03 


;GOT ETX YET? 




BEQ 


TTY4 


; KEEP WAITING TILL IT ECHOS 




JMP 


SCIXIT 




9 

TTY4: 


LDD 


#TTYR 


.WHEN GOT ETX, PREP TO REC DATA CHARS 




JMP 


RSET 


; SET RVECT TO TTYR AND EXIT 



9 

; TTY RECEIVE SECTION, ENTER HERE FROM COMMAND CHAIN W/O NEW CHAR 



TTYRO: 


STX 


XTTY 


;JUST SAVE TABLE POINTER 




BRA 


TTY4 


; AND GO GET A NEW CHAR 


; ENTER HERE FROM RVECT WITH DATA CHAR IN A 


TTYR: 


LDX 


XTTY 


; WHILE WE FIGURE OUT WHAT TO DO WITH IT 




JSR 


LBISX 


.GET THE CONTROL CHAR.. 


TRY90: 


CMPB 


#$90 


;SAVE WHOLE CHAR 




BNE 


TRY91 




SAVCHR: 


JSR 


LBISX 


;IF 90, SAVE WHOLE CHAR AT IMM ADDRESS 




JSR 


CRADDR 


.CREATE ADDRESS 




STAA 


0.X 


;SAVE THE DATA BYTE IN M(X) 




BRA 


CKNEXT 


.CHECK NEXT CONTROL BYTE FOR TYPE (READ OR 


WRITE) 








TRY91: 


CMPB 


#$91 


.ENTER A HEX PAIR? 




BNE 


TRY94 






JSR 


ASCHEX 






BCS 


TRERR 


;ABORT IF NOT HEX CHAR 
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ASLA 

ASLA 

ASLA 

ASLA 




.MOVE OVER 




ST A A 


SCRTCH1 


;SAVE TILL NEXT PASS 




LDD 


#TTYHEX 


;PREP FOR 2ND HEX CHAR 




JMP 


RSET 




TTYHEX: 


JSR 


ASCHEX 


;( SECOND HALF OF TRY91 ) 




BCS 


TRERR 


; ABORT IF NOT A VALID HEX CHAR 




ORAA 


SCRTCH1 


;COMBINE HIGH AND LOW CHARS 




LDX 


XTTY 






JSR 


LBISX 


;GET SINK ADDRESS 




JSR 


CRADDR 


.CREATE ADDRESS 




ST A A 


0,X 






LDD 


#TTYR 


.REPAIR THE VECTOR 




STD 


RVECT 


; AND ON TO CHECK NEXT COMMAND 




BRA 


CKNEXT 




TRY94: 


CMPB 


#$94 


;IS IT IN4? 




BNE 


TRERR 


.QUIT IF NOT A VALID CODE 


GOT94: 


CLR 


SCRTCH1 


;GOT FIRST DIGIT IN A, CLEAR INPUT BUFFER 




CLR 

PSHA 


SCRTCH2 


;SAVE THE ARGUMENT 




LDD 


#SAVE4 






STD 


VECT2 


.PREPARE EXIT VECTOR 




LDD 


#IN4HEX 






STD 

PULA 


RVECT 


.CHANGE RVECT 




JMP 


IN4HEX 


;AND PROCESS THE FIRST DIGIT 


* 

SAVE4: 


LDD 


#TTYR 






STD 


RVECT 


.REPAIR THE VECTOR 




LDX 


XTTY 


;GET THE TABLE POINTER 




JSR 


LBISX 


;AND GET THE SINK ADDRESS 




JSR 


CRADDR 


.CREATE ADDRESS 




LDD 


SCRTCH1 


;AND STORE THE DOUBLE BYTE 




STD 


0,X 






BRA 


CKNEXT 


;CHECK NEXT CONTROL CHAR 


CKNEXT: 


LDX 


XTTY 


;IS THE NEXT CONTROL CHAR AN INP OR OUT? 




LDAA 


o,x 


;GET THE CONTROL CHAR 




ANDA 


#$F0 


; AND CHECK THE HIGH NIBBLE 




CMPA 


#$90 


;IS IT AN INPUT TYPE? 




BNE 


TTYOL 


;IF NOT, SWITCH TO OUTPUT MODE 




JMP 


SCIXIT 


;ELSE GET ANOTHER CHAR 


> 

TTYOL: 


JMP 


TTYO 




LB1SX: 


LDAB 


O.X 


SUBROUTINE TO LOAD B, INC & STR X 




INX 




; USED BY TTY ABOVE 
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STX XTTY 
RTS 

CRADDR: LDX #$0000 .SUBROUTINE TO CREATE AN ADDRESS 

ABX 
RTS 



5 

; AFTER VALID ADDRESS, RECEIVE 



CONCH AR: 


ANDA 


#$7F 




CMPA 






BEQ 


SETBG 




CMPA 


tt'V 




BEQ 


SETQG 




CMPA 


#'0' 




BEQ 


TIMEJ 




CMPA 


#'P' 




BEQ 


TIMOUTJ 




CMPA 






BEQ 


DSCANL 




CMPA 


#'A' 




BEQ 


ATTCMD 




CMPA 


W ' 




BEQ 


GOMON 




CMPA 


#$0D 




BEQ 


GOMON 




CMPA 


#'H’ 




BEQ 


SAYHEL 




CMPA 


#'R' 




BEQ 


RSTARTJ 




CMPA 


U'V' 




BEQ 


AVOUTJ 




JMP 


SETUNAD 


GOMON: 


JMP 


PROMPT 


SAYHEL: 


.IMP 


SAYHELP 


DSCANL: 


JMP 


DSC AN 


TIME.I: 


JMP 


TIME 


TIMOUTJ: 


JMP 


TIMOUT 


RSTARTJ: 


JMP 


START 


AVOUTJ: 


.IMP 


AVOUT 


SETBG: 


LDD 


# BGROUP 




JMP 


RSET 


SETQG: 


LDD 


#QGROUP 




JMP 


RSET 


ATTCMD: 


LDD 


#ATTNGRP 




JMP 


RSET 


> 

BGROUP: 


NOP 






CMPA 


#T 




BEQ 


LTESTJ 



CONTROL CHAR.. 

•.CLEAN OFF FLAG BIT 
;IS IT T 

;OR IS IT '?' 

;IS IT 'O', START DATA COLLECTION? 
;IS IT 'P, PAUSE DATA COLLECTION? 
;IS IT DATA SCAN REQUEST? 

;IS IT'A', SET GAIN CONTROL? 

-.SPACE TO ENTER MONITOR? 

;CHAR RETURN TO ENTER MONITOR? 
;HELP? 

;RESTART? 

;ATTEN VALUE REQUEST 

•.UNADDRESS IF NOT VALID.. 

;I,INK INTO MONITOR 

;LINK TO SAYHELP 

;LINK TO DATA SCAN 

.LINK TO TIME 

;LINK TO TIMOUT 

;LINK TO START 

;LINK TO ATTEN VAL OUTPUT 

.PREPARE FOR THE CHAR AFTER ! 

.PREPARE FOR THE CHAR AFTER ? 

;PREPARE FOR THE CHAR AFTER A 
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if 


LOAD 






CMPA #'M’ 






BEQ 


BANGML 






endif 








JMP 


PROMPT 


» 




if 


LOAD 


BANG ML: 


JMP 


BANGM 






else 








endif 




LTESTJ: 




.IMP 


LTEST 


) 

QGROUP: 


NOP 








if 


VIEW 






CMPA 


H'M' 






BEQ 


QUERYML 






else 








endif 








JMP 


PROMPT 


* 




if 


VIEW 


QUERYML: 


JMP 


QUERYM 






else 








endif 




ATTNGRP: 


NOP 








CMPA 


#’ O' 






BEQ 


SETODBJ 






CMPA 


#T 






BEQ 


SET 1 DBJ 






CMPA 


#’2' 






BEQ 


SET2DBJ 






CMPA 


r 3’ 






BEQ 


SET3DBJ 






CMPA 


#’4' 






BEQ 


SET4DBJ 






CMPA 


#’5' 






BEQ 


SET5DBJ 






CMPA 


#’6' 






BEQ 


SET6DBJ 






CMPA 


#'A' 






BEQ 


AGCONJ 






JMP 


PROMPT 


SETODBJ 




JMP 


SETODB 


SET 1 DBJ 




JMP 


SET03DB 


SET2DBJ 




JMP 


SET09DB 


SET3DBJ 




JMP 


SET12DB 


SET4DBJ 




JMP 


SET 1 8DB 


SET5DBJ 




JMP 


SET24DB 



;L1NK TO !M 



;LINK TO ?M 

;MANUAL SET 0 DB ATTEN 
;MANUAL SET 3 DB ATTEN 
;MANUAL SET 9 DB ATTEN 
;MANUAL SET 12 DB ATTEN 
;MANUAL SET 18 DB ATTEN 
;MANUAL SET 24 DB ATTEN 
.MANUAL SET 30 DB ATTEN 
;SET AGC ON 

;LINK TO SETODB 
;LINK TO SET3DB 
;LINK TO SET09DB 
.LINK TO SET12DB 
.LINK TO SET18DB 
;LINK TO SET24DB 
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SET6DBJ: 


JMP 


SET30DB 


;LINK TO SET30DB 


AGCONJ: 


JMP 


AGCON 


;LINK TO AGCON 


;PAUSE REQUEST 




STOPS THE DATA DUMP 


TIMOUT: 


CLR 


TMSKI 


;DISABLE TOC2 INTERUPT 




LDAA 


#$FF 


;RESET TOC FLAGS 




STAA 


TFLGI 






JMP 


PROMPT 


.RETURN 


> 

•.START REQUEST 




TURN ON TIMER INTERUPT 


TIME: 


LDD 


TCNT 


.LOAD THE CURRENT TIMER VALUE 




ADDD 


# SAMPLE 


;SET AN INITIAL DELAY OF I.OmSEC 




STD 


DTOC2 






LDAA 


#$40 


.TURN ON OC2 INTERUPT 




STAA 


TMSKI 






JMP 


PROMPT 


.RETURN 



; DATA SCAN 

DSC AN: LDX #DSCANO 

JMP TTYO 
DSCANO: DB $AA 

DW DSC AN I 

DSCAN1: BRCLR TXIFLG,$OI,DSCAN2 ;HAS BUFFER I BEEN SENT YET? 

BRCLR TX 2FLG ,$0 1 .DSC AN3 ;HAS BUFFER 2 BEEN SENT YET? 



NOTYET: 


LDX 


flNOTRDY 




JMP 


TTYO 


NOTRDY: 


FCB 


$00,$00 


y 

DSCAN2: 


BSET 


TXIFLG,$0I 




LDX 


0MAXBUFI 




BRA 


DSCAN4 


DSCAN3: 


BSET 


TX2FLG,$01 




LDX 


0MAXBUF2 


DSCAN4: 


STX 


TXBUFF 




LDAB 

ABX 


MAXNUM 




STX 


TXBFULL 




LDY 


TXBUFF 




STY 


TXINT 


DSCAN5: 


LDAA 


$00, Y 




STAA 


TXMHI 




LDAA 


$0I,Y 




STAA 


TXMLO 




LDAA 


$10, Y 




STAA 


TXIHI 




LDAA 


$1 1.Y 




STAA 


TXILO 


’ 


LDX 


#BITSNDI 



.WAIT UNTIL A BUFFER IS READY 

;SET BUFFER I TX'D FLAG 

;SET BUFFER 2 TX'D FLAG 

.SAVE THE BUFFER TO TX IN TXBUFF 

.GENERATE THE BUFFER DONE VALUE 

.GET THE DATA POINT HI BYTE 

.STORE IN BASE PAGE 

;GET THE DATA POINT LOW BYTE 

.STORE IN BASE PAGE 

;GET THE INDEX HI BYTE 

;GET THE INDEX LOW BYTE 
;PREP FOR TX 
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JMP 


TTYO ;TX DATA POINT 


BITSND1 : 


DB 


$8 1 ,TXMHI,$ AA ;TX VIA TTY 




DW 


DTX1 


DTX1: 


LDX 


#BITSND2 ;PREP FOR TX 




JMP 


TTYO ;TX DATA POINT 


BITSND2: 


DB 


$8 1 ,TXMLO,$ AA ;TX VIA TTY 




DW 


DTX2 


DTX2: 


LDX 


#BITSND3 ;PREP FOR TX 




JMP 


TTYO ;TX DATA POINT 


BITSND3: 


DB 


$81,TXIHI,$AA ;TX VIA TTY 




DW 


DTX3 


DTX3: 


LDX 


#BITSND4 ;PREP FOR TX 




.IMP 


TTYO ;TX DATA POINT 


BITSND4: 


DB 


$81,TXILO,$AA ;TX VIA TTY 




DW 


DSCAN6 


> 

DSCAN6: 


LDY 


TXINT 




INY 






INY 






STY 


TXINT 




CPY 


TXBFULL ;HAS THE ENTIRE BUFFER BEEN SENT? 




BLO 


DSCAN5 


> 


LDAA 


#$00 




LDX 


TXBUFF ;CLEAR THE BUFFER THAT WAS TX'D 


DSCAN7: 


ST A A 


$00, X 




INX 






CPX 


TXBFULL 




BLO 


DSCAN7 




LDX 


#DSCAN8 ;END TX 




JMP 


TTYO 


DSCAN8: 


DB 


$00, $00 


» 

LTEST: 


LDX 


#RTEST 




JMP 


TTYR0 


> 

RTEST: 


DB 


$94, $80," GOT 4! SEND 4 MORE",$EE,$94,$84,"DONE",$00,$00 



0 DB MANUAL GAIN REQUEST 



SET0DB: 


BSET 


AGCFLG,$01 


;TURN OFF AGC 




LDAA 


#DB00 


;SET 0 DB ATTENUATION 




ST A A 


PORTA 






JMP 


PROMPT 


;RETURN 



> 

;3 DB MANUAL GAIN REQUEST 



SET03DB: 


BSET 


AGCFLG,$01 


;TURN OFF AGC 




LDAA 


#DB03 


;SET 3 DB ATTENUATION 




STAA 


PORTA 






JMP 


PROMPT 


.RETURN 
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;9 DB MANUAL GAIN REQUEST 
SET09DB: BSET AGCFLG.SOl 

LDAA #DB09 
STAA PORTA 
JMP PROMPT 



-.TURN OFF AGC 

-.SET 9 DB ATTENUATION 

.RETURN 



;12 DB MANUAL GAIN REQUEST 

SET12DB: BSET AGCFLG.SOl ;TURN OFF AGC 

LDAA #DB12 ;SET 12 DB ATTENUATION 

STAA PORTA 

JMP PROMPT ;RETURN 



-.18 DB MANUAL GAIN REQUEST 

SET18DB: BSET AGCFLG.SOl ;TURN OFF AGC 

LDAA #DB18 ;SET 18 DB ATTENUATION 

STAA PORTA 

JMP PROMPT .RETURN 



;24 DB MANUAL GAIN REQUEST 

SET24DB: BSET AGCFLG.SOl ;TURN OFF AGC 

LDAA #DB24 ;SET 24 DB ATTENUATION 

STAA PORTA 

JMP PROMPT .RETURN 



;30 DB MANUAL GAIN REQUEST 

SET30DB: BSET AGCFLG.SOl ;TURN OFF AGC 

LDAA #DB30 ;SET 30 DB ATTENUATION 

STAA PORTA 

JMP PROMPT ;RETURN 



;AGC ON REQUEST 
AGCON: CLR 

JMP 


AGCFLG ;SET AGC ON FLAG TO 0 (TURN AGC ON) 

PROMPT ;RETURN 


AVOUT: 


LDX 


# AVODAT 




JMP 


TTYO 


AVODAT: 


DB 


$81, PORTA, $00 ,$00 




JMP 


PROMPT 


************************************************************ 

* 

; HELP FILE 


HELPFIL 


:FCB 


•clp SAIL DRIVER Mon, Jun 7, 1993, 1 1 :53\$0D,$0A 




FCB 


Monitor Commands (enter via _ or ? or !)',$0D,$0A 




FCB 


' _ (space) enter monitor* ',$0D,$0A 




FCB 


' ?MaaaaJlllcr *’,$0D,$0A 




FCB 


' !Maaaa_dd...cr *',$0D,$0A 




FCB 


'Attenuator Commands (enter via A)’,$0D,$0A 




FCB 


' A0 sets 0 dB manual attenuation',$0D,$0A 




FCB 


' A1 sets 3 dB manual attenuation', SOD, $0A 




FCB 


' A2 sets 9 dB manual attenuation',S0D,S0A 




FCB 


' A3 sets 12 dB manual attenuation',S0D,S0A 
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FCB 


' A4 sets 18 dB manual attenuation', SOD, $0A 




FCB 


' A5 sets 24 dB manual attenuation', $0D,$0A 




FCB 


' A6 sets 30 dB manual attenuation', SOD, $0A 




FCB 


' AA turns AGC on’,$0D,$0A 




FCB 


'O starts receiver collecting samples',$0D,$0A 




FCB 


'P pauses receiver',$0D,$0A 




FCB 


'R resets the system', $0D,$0A 




FCB 


'with all RCA UT4 conventions’, SOD, $0A 




FCB 


' * returns prompt', $00 


.*********************************************************** 




ORG $FFD6 


VSCI: 


FDB 


SCI 


VSPI: 


FDB 


START 


VPAIE: 


FDB 


START 


VPAO: 


FDB 


START 


VTOF: 


FDB 


START 


VTOC5: 


FDB 


START 


VTOC4: 


FDB 


START 


VTOC3: 


FDB 


START 


VTOC2: 


FDB 


OC2 


VTOC1: 


FDB 


START 


VTIC3: 


FDB 


START 


VTIC2: 


FDB 


START 


VTIC1: 


FDB 


START 


VRTI: 


FDB 


START 


VIRQ: 


FDB 


START 


VXIRQ: 


FDB 


START 


VSWI: 


FDB 


START 


VILLOP: 


FDB 


START 


VCOP: 


FDB 


START 


VCLM: 


FDB 


START 


VRST: 


FDB 


START 




END 
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Appendix 3 



This appendix contains the C source code use by the Macintosh computer for 
the algorithm of figure 2-4. The user interface follows the guidelines specified by 
Apple, and the Event Manager is used to initiate all functions. After the hardware is 
initialized, the program waits in the EventLoop until an event is received. If no events 
are received in the loop cycle time, the program requests data from the 68HC1 1 and 
the GPS receiver. If the data is available, it is stored to form experiment vectors. 

Once enough experiment vectors are collected, the maximum likelihood estimate is 
calculated. The program the returns to the EventLoop. 



/***************************************************************************** 

TRACKER.C 

Dennis Michael Wojcik 
15 July 1993 

This program is version 1.0 of the Precision Tracking Receiver. It is tailored 
for the scenario of a stationary acoustic beacon and a moving observer. The 
program assumes that the observer has a GPS receiver for positioning data 
that can produce a fix at least every 2 seconds. If a different navigation 
system is used to provide ship locations, it is up to the user to provide 
the proper position format: 

?L HHMMSS,DDMM.hh,N,DDDMM.hh,E,x,x,DOP,xxx,M,xxxxx,M 



************************************************************************♦*♦**/ 
j* ************ ************** INCLUDES ****************************************/ 



^include 

^include 

^include 

^include 

^include 

^include 

^include 

^include 

^include 

^include 



<math.h> 

<AppleEvents.h> 

<GestaltEqu.h> 

<Values.h> 

<serial.h> 

<Packages.h> 

<string.h> 

<float.h> 

<stdlib.h> 

<stdio.h> 



// needed for math calls 
// needed to handle AppleEvents 
// needed to read system 7 AppleEvents 
// contains needed Mac constants 
// has needed serial comms constants 
// needed to call time functions 
// needed to call string functions 
// contains needed constants 
1 1 for standard calls such as strtoul etc 
// usefull for debugging 



^ *************************************************************************** I 
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' 



/*************************** DEFINES *****************************************/ 



//define kBaseResID 


128 


//define kMoveToFront 


(WindowPtr)-IL 


//define kUseDefauItProc 


(void *)-IL 


//define kSIeep 


1L 


#define kLeaveWhereltls 


false 


//define mAppIe 


kBaseResID 


//define i About 


1 


//define mFile 


kBaseResID* I 


//define iQuit 


I 


//define mAttenuator 


kBaseResID+3 


//define iAuto 


I 


//define iOdB 


2 


//define i3dB 


3 


//define i9dB 


4 


//define i 1 2dB 


5 


//define iI8dB 


6 


//define i24dB 


7 


//define i30dB 


8 


//define mBaud 


kBaseResID+4 


//define i300 


I 


//define i600 


2 


//define i 1 200 


3 


//define i2400 


4 


//define i4800 


5 


//define i9600 


6 


//define mSignal 


kBaseResID+5 


//define iPeriod 


1 


//define iNumMax 


2 


//define iWindow 


3 


//define iMessageText 


4 


//define kPeriodDialog 


kBaseResID 


//define kNumMaxDialog 


kBaseResID* I 


//define kWindowDialog 


kBaseResID+2 


//define kLeftMargin 


4 


//define kFontSize 


10 


//define kRovvHeight 


(kFontSize+2) 


//define kDataScanHeight 


1 


//define kHorizontalOffset 


0 


//define kGestaltMask 


IL 


//define kHorizontalPix 


30 


//define kVerticalPix 


40 


//define kMinWindowHeight 


50 


//define kMinWindowWidth 


80 


//define kMinTextPosition 


0 



// define general resource infor 



// Apple menu resource ID 



// File menu resource ID 



// Attenuator menu resource ID 



// Baud Rate menu resource ID 



// Signal menu resource ID 



// define screen margins 
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//define kMaxTextPosition 


32767 




//define kScrollbarAdjust 


(16-1) 


// define update constants 


//define kNormalUpdates 


true 




//define bufferSize 


1024 


// misc. default values 


//define kl6Bit 


4 




//define k8Bit 


2 




//define kHexBase 


16 




//define kpi 


3.141592654 




//define kNumExp 


6 


// default experiment parameters 


//define kParameters 


3 




//define kNumMeas 


6 




//define kStep 


15 




//define kC 


1500 




//define kMaxR 


5000.0 




//define kMaxD 


-5000.0 




//define kMinD 


-1.0 




//define kxvar 


9.0 




//define kyvar 


9.0 




//define ktvar 


8.3333e-2 





/*****************************************************************************/ 

/* ************************** MACROS ******************************************/ 

//define TopLeft( r ) (*(Point *) &(r).top) 

//define BottomRight( r ) (*(Point *) &(r).bottom) 

/*****************************************************************************/ 

^* ************************** GLOBALS *****************************************/ 



int 

Boolean 

Rect 

int 

int 

unsigned long 

long 

char 

char 

short 

Str255 

unsigned long 
WindowPtr 



gASerRefin, gASerRefOut; 

gDone, gHasPopupControl, gDataScan; 

gTrackerRect; 

gverticalPixels; 

gRowStart, gDataRowStart, gserConfig; 

gPeriod=2000UL; 

gNumMax=2L, gWindow=20L; 

gDataBuffer[bufferSize]; 

gGPSBuffer[bufferSize]= 

M L 1 45642,0000.00,N, 00000. 00,E,0,0 ,000,000, M,0000,M"; 
gLastAttn=l, gLastBaud=6; 
gltemText; 
ghorizontalPixels; 

gWetPaperWind, gTerminalWind, gRangeWind; 



long 

long 

unsigned long 

double 

Boolean 



gPulseCounter=0L; 
g CheckVal=lL; 
gtimel, gtime2; 

gXref, gYref, gXl, gX2, gYl, gY2; 
gstarter=true; 
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Boolean 

Boolean 

double 

unsigned long 
double 
double 
double 



greflag=true; 

gDataWrap=false, trackerStart=false; 
gYFact; 

gt_mul, gt_mu2; 

gV[kNumMeas]={kxvar,kyvar,ktvar,kxvar,kyvar,ktvar}; 
gtheta[3]={ 0.0, 0.0, -2000.0}, gPosition[kParameters]; 
♦gw; 



double 

int 

int 

long 

double 

char 

char 



gxold=0.0, gyold=0.0; 

gnumlts=0; 

gmu=0; 

gi=0L,gnumExp=0L; 

gYrefString[8]; 

gXrefString[9]; 



/*****************************************************************************/ 



FUNCTION PROTOT YPES* ♦ ******************************/ 



void 

void 

void 

void 

void 

void 

unsigned long 

void 

void 

void 

void 

void 

void 

void 

void 

unsigned long 

void 

void 

int 

void 

void 

void 

unsigned 

int 

void 

int 

int 

void 

unsigned long 
double 
double 
void 

pascal OSErr 



ToolBoxInit(void); 

Windowlnit(void); 

MenuBarlnit(void); 

Serial Init(void); 

EventLoop(void); 

DoEvent( EventRecord *eventPtr ); 

HandleDataIn(int numDataPoins); 
HandleMouseDown(EventRecord ♦eventPtr); 
HandleMouseUp(EventRecord ♦eventPtr); 
HandleMenuChoice( long menuChoice ); 
HandleAppleChoice( short item ); 

HandleFileChoice( short item ); 

HandleAttenuator(short item); 

HandleBaud(short item); 

HandleSignal(short item); 

HandleDialog(int dialogRes); 

ConcatString(Str255 strl, Str255 str2); 

HandleKeyIn( char theChar); 

TalkSail( char theChar); 

Display String(int numDataPoints); 

ScrollDisplay(void); 

HandleNull( void ); 

HexCharToInt(char Bite, int exponent); 
DecIntToHexChar(int decimal); 

DoUpdate(EventRecord ♦eventPtr); 

Power(int base, int exponent); 

DecIntToHexChar(int decimal); 

ScrollDataScan(void); 

DecTimeToSec(unsigned long timeVal); 

LatToY(double latVal); 

LongToX(double longVal, double cosfact); 
tracker(long numExp); 

SetDialogDefaultItem(DialogPtr theDialog, short newltem) 



191 



={ 0x303C, 0x0304, 0xAA68}; 

pascal OSErr SetDialogCancelItem(DialogPtr theDialog, short newltem) 

= {0x303C, 0x0305, 0xAA68}; 

pascal OSErr SetDialogTracksCursor(DialogPtr theDialog, Boolean tracks) 

={0x303C, 0x0306, 0xAA68}; 

/*****************************************************************************/ 



I* Main ♦/ 

void main(void) 

{ 

WindowPtr window; 

OSErr RAMOpenErr, resetErrln, resetErrOut, bufSizeErr; 

int SerConfig; 

Ptr serBPtr; 

char serInBuffer[bufferSize]; 

long numCharln, numCharOut, maxtime; 

char addressBuf[20]; 

ToolBoxInitO; // initialize the toolboxes 

WindowInitO; // set up the windows 

MenuBarlnitO; // draw the menu bar 

SeriallnitO; // open the serial drivers 



window=FrontWindow(); 
RAMOpenErr=RAMSDOpen(sPortA); 
if (RAMOpenErr != noErr) 

{ 



// ensure we're in the window 
// open the RAM Serial Drivers 
// if we can't open RAM Driver beep 



SysBeep(lO); 

ScrollDisplayO; 

DrawString("\pProblem opening the RAM Serial Drivers."); 



} 

gserConfig=baud9600+data8+stopl0+noParity; // Set the protocal for 9600 

// 8 data, 1 stop, no parity 

resetErrIn=SerReset(gASerRefIn,gserConfig); 

resetErrOut=SerReset(gASerRefOut,gserConfig); 

if ((resetErrln != noErr) || (resetErrOut != noErr)) 

{ 

SysBeep(lO); // if we can't set the protocal 

ScrollDisplayO; // beep 

DrawString("\pProblem setting the serial protocal."); 

} 



serBPtr=serInBuffer; // Set the serial buffer size 

bufSizeErr=SerSetBuf(gASerRefIn,serBPtr,bufferSize); 
if (bufSizeErr != noErr) 

{ 

SysBeep(lO); // if we can't set the buffer 

ScrollDisplayO; // size, beep 

DrawString("\pProblem resizing the serial input buffer."); 

} 



ScrollDisplayO; 
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numCharOut-5L; // see if we can talk to the GPS receiver 

FSWrite(gASerRefOut, &numCharOut, "//GPS "); 

SerGetBuf(gASerRefin,&numCharIn); 
maxtime=TickCount()+20L; 
while(numCharIn < 9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCountO > maxtime) 

{ 

SysBeep(lO); 

DrawString("\p Can't talk to the GPS reciever, unable to run!!"); 

ScrollDisplayO; 

break; 

} 

} 

FSRead(gASerRefIn,&numCharIn,&addressBuf); 

numCharOut=5L; // see if we can talk to the PTR receiver 

FSWrite(gASerRefOut, &numCharOut, "//PTR "); 

SerGetBuf(gASerRefIn,&numCharIn); 
maxtime=TickCountO+20L; 
while(numCharIn < 9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCountO > maxtime) 

{ 

SysBeep(lO); 

DrawString("\p Can't talk to the PTR reciever, unable to run!!"); 

ScrollDisplayO; 

maxtime=TickCount()+l 20L; 

while(TickCountO < maxtime) 

TickCountO; 

abortO; 

} 

} 

FSRead(gASerRefIn,&numCharIn,&addressBuO; 

TalkSail('O'); // start the PTR’s data collection 

DrawString("\p: "); // display a cursor 

gw = calloc(3L*kStep*(kNumExp+l),sizeof(double)); // get memory for data 

if (gw == NULL) 

{ 

DrawString("\pCan't allocate memory for data collection!!!"); 
abortO; 

} 

EventLoopQ; // main execution loop 



RAMSDClose(sPortA); 



// must close the RAM Drivers before shutdown 



free(gw); // must release the memory before shutdown 

} 

/* V 



I* ToolBoxInit */ 

void ToolBoxInit(void) 

{ // initialize all of the ToolBox 

InitGraf(&thePort); // Routines 

InitFontsQ; 

InitWindowsO; 

InitMenusQ; 

TEInitO; 

InitDialogs(nil); 

InitCursorO; 

} 

/* */ 



/* Windowlnit - */ 

void Windowlnit(void) 

{ // initialize the display windows 

WindowPtr window; 

short fontNum; 

Boolean update = true; 

window = GetNewWindow(kBaseResID, nil, kMoveToFront); 



if (window == nil) 

{ 

SysBeep(lO); // Couldn’t load the WIND resource 

ExitToShellQ; 

} 

SetPort(window); // set the window to be active 

GetFNum("\pTimes”, &fontNum); // use Times font 

if (fontNum != 0) TextFont(fontNum); 

TextSize(kFontSize); // use the default font size 

gverticalPixels=screenBits.bounds.bottom-screenBits.bounds.top-45; 

ghorizontalPixels=screenBits.bounds.right-screenBits.bounds.left-10; 

gDataRowStart=gverticalPixels-2*kFontSize; 

SizeWindow(window, ghorizontalPixels, gverticalPixels, update); 

ShowWindow(window); // activate the window 

gWetPaperWind=FrontWindowQ; 

gTerminalWind = GetNewWindow(kBaseResID+l, nil, kMoveToFront); 
if (gTerminalWind == nil) 
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SysBeep(lO); 

ExitToShellQ; 



// Couldn’t load the WIND resource 



{ 



} 

SetPort(gTerminalWind); // set the window to be active 

GetFNum("\pTimes”, &fontNum); // use Times font 

if (fontNum != 0) TextFont(fontNum); 

TextSize(kFontSize); // use the default font size 

gRowStart=gTerminalWind->portRect.bottom-2*kFontSize; 

ShowWindow(gTerminalWind); 

} 

/* *1 



f* MenuBarlnit ♦/ 

void MenuBarlnit(void) 

{ 

Handle menuBar; 

MenuHandle menu; 

menuBar = GetNewMBar( kBaseResID ); 

SetMenuBar( menuBar ); 

menu = GetMHandIe( mApple ); 

AddResMenu( menu, 'DRVR'); 

DrawMenuBarO; 

} 

/* */ 



/* Seriallnit 

void Seriallnit(void) 

{ 

WindowPtr window; 

OSErr openErr, RAMErr, resetErr ; 

int serConfig; 

char driverStringIn[]="\p.AIn”; 

char driverStringout[]=’’\p.Aout”; 



V 



// define system errors 
// define the port configuration 
// define the input driver name 
// define the output driver name 



windo w=F ront Windo w() ; 



openErr=OpenDriver(driverStringIn,&gASerRefIn); // Open the port A ROM input serial driver 
if (openErr != 0) 

{ 

SysBeep(lO); 

ScrollDisplayO; 

DrawString(”\pCan't open the ROM Serial input driver’’); 
return; 
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} 



openErr=OpenDriver(driverStringout,&gASerRefOut); // Open the port A ROM output 

//serial driver 

if (openErr != 0) 

{ 

SysBeep(lO); 

ScrollDisplayQ; 

DrawStringC'XpCan't open the ROM Serial output driver”); 
return; 

} 



gserConfig=baud9600+data8+stopl0+noParity; // Set the protocal for 

// 9600, 7D, IS, no parity 



resetErr=SerReset(gASerRefIn,gserConfig); // Set the input driver to the new protocal 

if (resetErr != 0) 

{ 

SysBeep(lO); 

ScrollDisplayQ; 

DrawString("\pCan't set the ROM Serial input protocal"); 
return; 

} 



resetErr=SerReset(gASerRefOut,gserConfig); // Set the output driver to the new protocal 

if (resetErr != 0) 

{ 

SysBeep(lO); 

ScrollDisplayQ; 

DrawString("\pCan't set the ROM Serial output driver"); 
return; 

} 



} 

/* */ 



/* EventLoop */ 

void EventLoop(void) 

{ 

EventRecord event; 
gDone = false; 

while (gDone == false) // loop here until done with program 

{ 

if (WaitNextEvent(everyEvent, &event, kSleep, nil)) 

DoEvent(&event); 



else 

HandleNullQ; // collect data here 

} 

} 

/♦ V 
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/♦--- 

void 

{ 



DoEvent 

DoEvent(EventRecord *eventPtr) 



Boolean 

char 



becomingActive; 

theChar; 



switch (eventPtr->what) 

{ 



case mouseDown: 

HandleMouseDown(eventPtr); 
break; 
case mouseUp: 

HandleMouseUp(eventPtr); 
break; 
case keyDown: 

theChar = eventPtr->message & charCodeMask; 
if((eventPtr->modifiers & cmdKey) != 0) 

HandleMenuChoice(MenuKey( theChar)); 

else 

HandleKeyIn( theChar ); 

break; 
case updateEvt: 

DoUpdate( eventPtr); 
break; 



case activateEvt: 

becomingActive = ((eventPtr->modifiers & 



activeFlag) == 
activeFlag); 




} 



} 

/♦ 



/♦— ■ 
void 
{ 



HandleNull(void) 



•HandleNull 



V 



int 

int 

int 

long 

char 

char 

char 

char 

char 

char 

char 

char 



numGPSPoints; 

numDataPoints; 

GPSbuff; 

numCharOut, numCharln, numCharlnOld; 
addressBuf[bufferSize]; 

*tok; 

♦timeOfRx; 

*latitude; 

♦longitude; 

*HDOP; 

*delim= M 

♦end; 
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int 


i; 


unsigned long int 


timeVal; 


double 


latVaUongVal,HDOPVal; 


double 


cosfact; 


unsigned long 


t_mu; 


long 


maxtime; 


Str255 


numstr; 


char 


*lattest=" 1234.89"; 


double 


lattestd, dl; 


long 


lattestdec,lattestr; 


double 


timemod; 



if (gDataScan == true) 

{ 

/* — > use this part when the GPS receiver is available 
numCharOut=5L; 

FSWrite(gASerRefOut } &numCharOut, "//GPS "); 
SerGetBuf(gASerRefIn,&numCharIn); 
maxtime=TickCount()+20L; 
while(numCharIn < 9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCountO > maxtime) break; 

} 

FSRead(gASerRefIn,&numCharIn,&addressBuf); 

numCharOut=2L; 

FSWrite(gASerRefOut, &numCharOut, "?L"); 
SerGetBuf(gASerRefin,&numCharIn); 
maxtime=TickCountO + 20L; 
while(numCharIn < 55L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCountO > maxtime) break; 

} 

FSRead(gASerRefln,&numCharIn,&gGPSBuffer); 



numCharOut=5L; 

FSWrite(gASerRefOut, &numCharOut, "Z/PTR "); 
SerGetBuf(gASerRefIn,&numCharIn); 
maxtime=TickCount()+20L; 
while(numCharIn < 9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
if(TickCountQ > maxtime) break; 

} 

FSRead(gASerRefIn,&numCharIn,&addressBuf); 

numDataPoints=TalkSail('-'); 
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if(numDataPoints > 5) 

{ 

gPulseCounter++; 



tok=strtok(gGPSBuffer,delim); 

timeOfRx=strtok(NULL,delim); 

latitude=strtok(NULL,delim); 

tok=strtok(NULL ,delim) ; 

longitude=strtok(NULL,delim); 

tok=strtok(NULL,delim); 

tok=strtok(NlJLL,delim); 

tok=strtok(NULL,delim); 

HDOP=strtok(NULL,delim); 

time Val=strtoul(timeOfRx,&end, 1 0); 

latVal=strtod(latitude,&end); 

longVal=strtod(longitude,&end); 

HDOPVal=strtod(HDOP,&end); 

if (HDOPVal < 10.0) 

{ 

if (gstarter == true) 

{ 

t_mu=HandleDataIn(numDataPoints); 

gtime2=DecTimeToSec(timeVal); 

gX2=0.0; 

gY2=0.0; 

if (greflag == true) 

{ 

gYref=LatToY(latVal); 

gYFact=cos((gYref/(l 853. 2*60. 0))*kpi/l 80.0); 

gXref=LongToX(longVal,gYFact); 

greflag=false; 

} 

gstarter=false; 

} 

else 

{ 

t_mu=HandleDataIn(numDataPoints); 

/* — > use this if GPS availble to see if Fixes are 2 sec apart 



*/ 



if(DecTimeToSec(timeVal) != gtime2-2UL) 
if(DecTimeToSec(timeVal) != gtime2) 



{ 

gstarter=true; 

} 

else 

{ 

gtimel=gtime2; 

gtime2=DecTimeToSec(timeVal); 



199 



gXl=gX2; 

gX2=LongToX(longVal,gYFact)-gXref; 

gYl=gY2; 

gY2=LatToY(latVal)-gYref; 



// — > make up data to test program 



// — > end of simulated data 
/* — >use this if GPS available 



♦/ 



gw[gi]=gxold+cos(0.00515*gj)*5. 14778; 
gw[gi+l ]=gyold+sin(0.005 1 5*gj)*5. 1 4778; 

gxold=gw[gi]; 

gyold=gw[gi+l]; 

d 1 =sqrt((gxold- 1 000) *(gxold- 1 000) 

+(gyold-2000)*(gyold-2000)+3000*3000); 
timemod=dl/1.5; 
vvhile(timemod > 2000.0) 

timemod=timemod-2000.0; 

gw[gi+2]=timemod; 



gw[gi]=(1.0-t_mu/((gtime2-gtimel)* 1000.0)*gXl 
+gX2; 

g\v[gi+l ]=( 1 .0-t_mu/((gtime2-gtime 1 )* 1 000.0)*g Y 1 
+gY2; 

gw[gi+2]=t_mu; 



gi=gi+3L; 

if(gi >= 3L*(kStep*kNumExp+lL) ) 
trackerStart=true; 

if(gi >= 3L*kStep*(kNumExp+lL) ) 

{ 

gi=0L; 

gDataWrap=true; 

} 

if((trackerStart == true) || (gDataWrap == true)) 

{ 

tracker(gnumExp); 

} 



} 

} 

} 

else 

{ 

t_mu=HandleDataIn(numDataPoints); 
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} 



gstarter=true; 



/* */ 



/* DecTimeToSec */ 

unsigned long DecTimeToSec(unsigned long timeVal) 

{ 

unsigned long hr, min, sec, timeSec; 

hr=timeVal/l 0000UL; 
min=(timeVal-hr* 10000UL)/100UL; 
sec=timeVal-hr* lOOOOUL-min* 100UL; 

timeSec=hr*3600UL+min*60UL+sec; 

retum(timeSec); 

} 



/* 



*/ 



/*- LongToX */ 

double LongToX( double longVal, double cosfactor) 

{ 

long double deg, min, X; 

deg=floor(longVal/100.0); 
min=(longVal-deg* 100.0); 

X= = (deg*60.0+min)*1853.2*cosfactor; 

retum(X); 

/* */ 



/♦ LatToY- */ 

double LatToY(double latVal) 

{ 

long double deg, min, Y; 

deg=floor(latVal/ 1 00.0); 
min=(latVal-deg* 1 00.0); 

Y=(deg*60.0+min)* 1 853 .2; 

retum(Y); 
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/*— 

void 

{ 



HandleMouseDown 

HandleMouseDovvn(EventRecord *eventPtr) 



WindowPtr 

GrafPtr 

short 

long 



which Window; 
oldPort; 
thePart; 
menuChoice; 



*/ 



thePart — FindWindow(eventPtr->where, &whichWindow); 



switch(thePart) 

{ 

case inMenuBar: 

menuChoice = MenuSelect( eventPtr->where ); 

HandleMenuChoice( menuChoice ); 

break; 

case inSysWindow: 

SystemClick(eventPtr, whichWindow); 
break; 
case inContent: 

SetPort( whichWindow); 

GlobalToLocal( &eventPtr->where); 
break; 

case inDrag: 

DragWindow(whichWindow, eventPtr->where, 
&screenBits. bounds); 

break; 

case inGoAway: 

gDone = true; 
break; 

} 

} 

/* *1 



/* HandleMouseUp */ 

void HandleMouseUp(EventRecord *eventPtr) 

{ 

// Put some function in here 

} 

/* */ 



/* HandleMenuChoice */ 

void HandleMenuChoice(long menuChoice) 

{ 



short 



menu; 



short 



item; 



if (menuChoice != 0) 

{ 

menu=HiWord(menuChoice); 

item=LoWord(menuChoice); 

switch(menu) 

{ 

case mApple: 

HandleAppleChoice(item); 
break; 
case mFile: 

HandleFileChoice(item); 

break; 

case mAttenuator: 

HandleAttenuator(item); 

break; 

case mBaud: 

HandleBaud(item); 
break; 
case mSignal: 

HandleSignal(item); 

break; 

} 

HiliteMenu(O); 

} 

} 

/* */ 



/* Handle AppIeChoice */ 

void HandleAppleChoice( short item ) 

{ 

MenuHandle appleMenu; 

Str255 accName; 

short accNumber; 

switch(item) 

{ 

case iAbout: 

NoteAlert(kBaseResID,nil); 

break; 

default: 

appleMenu = GetMHandle(mApple); 
GetItem(appleMenu, item,accName); 
accNumber=OpenDeskAcc(accName); 
break; 

} 



*/ 



} 

/* 
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/* I landleFileChoice */ 

void HandleFileChoice(short item) 

{ 

switch(item) 

{ 

case iQuit: 

gDone = true; 
break; 

} 

} 

/* */ 



/* HandleAttenuator */ 

void HandleAttenuator(short item) 

{ 

MenuHandle menuHandle; 

long numCharOut, numCharln; 

char attenBuff[10], addressBuf[ 10]; 

numCharOut=5L; 

FSWrite(gASerRefOut, &numCharOut, ”#PTR "); 
SerGetBuf(gASerRefIn,&numCharIn); 
while(numCharIn < 9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 

} 

FSRead(gASerRefIn,&numCharIn,&addressBuf); 

numCharOut=2L; 

numCharIn=6L; 

menuHandle=GetMHandle(mAttenuator); 

CheckItem(menuHandle,gLastAttn, false); 

CheckItem(menuHandle,item,true); 

gLastAttn=item; 

switch(item) 

{ 

case iAuto: 

FSWrite(gASerRefOut, &numCharOut, ”AA”); 
break; 
case iOdB: 

FSWrite(gASerRefOut, &numCharOut, "AO"); 
break; 
case i3dB: 

FSWrite(gASerRefOut, &numCharOut, "Al"); 
break; 
case i9dB: 

FSWrite(gASerRefOut, &numCharOut, ”A2 H ); 
break; 
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case il2dB: 

FSWrite(gASerRefOut, &numCharOut, "A3"); 
break; 
case il8dB: 

FSWrite(gASerRefOut, &numCharOut, "A4"); 
break; 
case i24dB: 

FSWrite(gASerRefOut, &numCharOut, "A5"); 
break; 
case i30dB: 

FSWrite(gASerRefOut, &numCharOut, "A6"); 
break; 

} 

FSRead(gASerRefIn, &numCharIn, attenBuff); 

} 

/* V 



/*— 

void 

{ 



numCharOut=8L; 

menuHandle=GetMHandle(mBaud); 

CheckItem(menuHandle,gLastBaud,false); 

CheckItem(menuHandle,item,true); 

gLastBaud=item; 

switch(item) 

{ 

case i300: 

FSWrite(gASerRefOut, &numCharOut, H #0000300 H ); 
gserConfig=baud300+data8+stopl0+noParity; 
break; 
case i600: 

FSWrite(gASerRefOut, &numCharOut, "#0000600"); 
gserConfig=baud600+data8+stopl0+no Parity; 
break; 
case i 1 200: 

FSWrite(gASerRefOut, &numCharOut, "#0001200"); 
gserConfig=baud 1 200+data8+stop 1 0+noParity ; 
break; 
case i2400: 

FSWrite(gASerRefOut, &numCharOut, "#0002400"); 
gserConFig=baud2400+data8+stopl0+noParity; 



HandleBaud- 

HandleBaud(short item) 



MenuHandle menuHandle; 

long numCharOut, numCharOutr, numCharln; 

int serConFig; 

OSErr resetErrln, resetErrOut; 

char inBuff[8]; 

SerStaRec serialStatusOut; 
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break; 
case i4800: 

FSWrite(gASerRefOut, &numCharOut, "#0004800"); 
gserConfig=baud4800+data8+stopl0+noParity; 
break; 
case i9600: 

FSWrite(gASerRefOut, &numCharOut, "#0009600”); 

gserConfig=baud9600+data8+stopl0+noParity; 

break; 

} 

SerStatus(gASerRefOut,&serialStatusOut); 

while ((serialStatusOut.rdPend != 0) || (serialStatusOut.wrPend !=0)) 

{ 

SerStatus(gASerRefOut,&serialStatusOut); 

} 

FSRead(gASerRefIn, &numCharOut, &inBufO; 
resetErrOut=SerReset(gASerRefOut,gserConfig); 

resetErrIn=SerReset(gASerRefIn,gserConfig); // Set the protocal 

if ((resetErrln != noErr) || (resetErrOut != noErr)) 

{ 

SysBeep(lO); 

ScrollDisplayO; 

DravvString("\pProblem setting the serial protocal."); 

} 

} 

/* V 



/* HandleSignal */ 

void HandleSignal(short item) 

{ 

Str255 periodData="\p!M52 "; 

Str255 numMaxData="\p! M63 "; 

Str255 windowData="\p!M74 "; 

char hexChar; 

long numCharOut, numCharln; 

char inbuff[30], outbuff[20], addressBuf[10]; 

int cr[l] ={13}; 

int radix, hexDec; 

short i; 

int period, numMax, window; 

SerStaRec serialStatusOut; 



numCharOut=5L; 

FSWrite(gASerRefOut, &numCharOut, "#PTR "); 
SerGetBuf(gASerRefIn,&numCharIn); 
while(numCharIn < 9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
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} 

FSRead(gASerRefIn,&numCharIn,&addressBuf); 

switch(item) 

{ 

case iPeriod: 

gPeriod=HandleDialog(kPeriodDialog); 

period=gPeriod; 

for (i=0;i < kl6Bit; i++) 

{ 

radix=Power(kHexBase,k 1 6Bit- 1 -i); 
hexDec=period/radix; 
hexChar=DecIntToHexChar(hexDec); 
periodData[ l+i+periodData[0]]=hexChar; 
period=period-hexDec*radix; 

} 

periodData[periodData[0]+kl6Bit+l]=cr[0]; 

periodData[0]=periodData[0]+kl6Bit+l; 

for (i=0;i<periodData[0];i++) 

{ 

outbuff[i]=periodData[i+l]; 

} 

numCharOut=periodData[0]; 
break; 
case iNumMax: 

gNumMax=HandleDialog(kNumMaxDialog); 

nurnMax=gNumMax*2; 

for (i=0;i < k8Bit; i++) 

{ 

radix=Po\ver(kHexBase,k8Bit- 1 -i); 

hexDec=numMax/radix; 

hexChar=DecIntToHexChar(hexDec); 

numMaxData[l+i+nurnMaxData[0]]=hexChar; 

numMax=numMax-hexDec*radix; 

} 

numMaxData[numMaxData[0]+k8Bit+l]=cr[0]; 

numMaxData[0]=nurnMaxData[0]+k8Bit+l; 

for (i=0;i<numMaxData[0];i++) 

{ 

outbuff[i]=numMaxData[i+l]; 

} 

numCharOut=numMaxData[0]; 
break; 
case iWindow: 

gWindo\v=HandleDialog(kWindowDialog); 

window=gWindow; 

for (i=0;i < kl6Bit; i++) 

{ 

radix=Power(kHexBase,k 1 6Bit- 1 -i); 
hexDec=window/radix; 



207 



hexChar=DecIntToHexChar(hexDec); 
windovvData[l+i+numMaxData[0]]=hexChar; 
vvindow=\vindow-hexDec* radix; 

} 

windowData[windowData[0]+kl6Bit+l]=cr[0]; 

windo\vData[0]=vvindowData[0]+kl6Bit+l; 

for (i=0;i<windowData[0];i++) 

{ 

outbuff[ i ] = wi ndo wDa ta [ i + 1 ] ; 

} 

numCharOut=windowData[0]; 

break; 

} 

FSWrite(gASerRefOut,&numCharOut,&outbuff); 

while(l == 1) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 

FSRead(gASerRefIn, &numCharIn, &inbuff); 

if(inbuff[numCharIn-lL] == 03) break; 

} 



} 

/* */ 



/* DecIntToHexChar ♦/ 

int DecIntToHexChar(int decimal) 

{ 

int hexChar; 

if ((decimal >= 0) & (decimal < 10)) 
hexChar=48+decimal; 
if ((decimal >= 10) & (decimal < 16)) 
hexChar=55+decimal; 

retum(hexChar); 

} 

/* */ 



/* ConcatString */ 

void ConcatString(Str255 strl, Str255 str2) 

{ 

short i; 

for(i=strl[0];i<str2[0]+strl[0];i++) 

{ 

strl[i+l]=str2[i-strl[0]+l]; 
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} 

/* 



} 

strl[0]=i; 



*/ 



/* HandleDialog 



unsigned long 

{ 

WindowPtr 

DialogPtr 

Boolean 

Handle 

Handle 

short 

Rect 

long 

unsigned long 



HandleDialog(int dialogRes) 

window; 

dialog; 

dialogDone; 

textltemHandle; 

okltemHandle; 

itemType, itemHit; 

itemRect; 

itemNum; 

itemNumU; 



♦/ 



window=FrontWindow(); 

dialog=GetNewDialog(dialogRes,nil,kMoveToFront); 

ShowWindow(dialog); 

SetPort(dialog); 

/* SetDialogDefaultItem(dialog, ok); 

SetDialogCancelItem(dialog, cancel); 
SetDialogTracksCursor(dialog, true); 

*/ 



GetDItem(dialog, iMessageText, &itemType, 

&textItemHandle, &itemRect); 

GetDItem(dialog, ok, &itemType, &okItemHandle, 

&itemRect); 

SelIText(dialog, iMessageText, kMinTextPosition, kMaxTextPosition); 

dialogDone=false; 

while( ! dialogDone) 

{ 

GetIText(textItemHandle, &gItemText); 

ModalDialog(nil, &itemHit); 

switch(itemHit) 

{ 

case ok: 
case cancel: 

dialogDone=true; 

break; 

} 

} 

DisposeDialog(dialog); 
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Select Window(window); 
SetPort(window); 

StringToNum(gItemText, &itemNum); 

itemNumU=itemNum; 

retum(itemNumU); 



} 

/* 



V 



/*— 

void 

{ 



gtempRgn = NewRgnO; 

switch(theChar) 

{ 

case 'W': 

gDa ta Sea n= fa 1 se ; 

SelectWindow(gTerminalWind); 

SetPort(gTerminalWind); 

DrawString("\pW"); 

ScrollDisplayO; 

DrawString("\p: M ); 

break; 

case 'K': 

gDataScan=false; 

SelectWindow(gTerminalWind); 

SetPort(gTerminalWind); 

numCharOut=5L; 

FSWrite(gASerRefOut, &numCharOut, H #PTR H ); 
SerGetBuf(gASerRefIn,&numCharIn); 
while(numCharIn < 9L) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 

} 

FSRead(gASerRefIn,&numCharIn,&addressBuO; 

bufferLength=TalkSail('P'); 

Display String(bufferLength); 

gi=0L; 

break; 

case 

gDataScan=true; 

SelectWindow(gWetPaperWind); 

SetPort(gWetPaperWind); 



HandleKeyln 

HandleKeyIn(char theChar) 



-*/ 



int bufferLength, i; 

RgnHandle gtempRgn; 

long numCharOut, numCharln; 

char addressBuf[10]; 
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for (i=0;i < 10;i++) 

{ 

ScrollDataScanO; 

} 

numCharOut=5L; 

FSWrite(gASerRefOut, &numCharOut, "#PTR "); 
SerGetBuf(gASerRefin,&numCharIn); 
vvhile(numCharIn < 9L) 

{ 

SerGetBuf(gASerRefln,&numCharIn); 

} 

FSRead(gASerRefIn,&numCharIn,&addressBuf); 

bufferLength=TalkSail(’0'); 

bufferLength=TalkSail(theChar); 

break; 

default: 

Select Window(gTerminal Wind); 

SetPort(gTerminalWind); 

bufferLength=TalkSail(theChar); 

Display String(bufferLength); 
break; 



} 

/* ♦/ 



/* HandleDataln 

unsigned long HandleDataIn(int numDataPoints) 

{ 



int 

char 

unsigned 
unsigned long 
Str255 

unsigned long 

float 

Str255 



j; 

max[8][4], time[8][4]; 

timelnt[8], maxlnt[8]; 

timeLong; 

timeOfMaxString; 

drawTime, dtemp, horizontalPosit; 

fraction; 

numpixel,horstring; 



*/ 



for (j=0;j<gNumMax;j++) 

{ 

for (i=0;i<4;i++) 

{ 

m ax[j][i]=gDataBuffer[8*j+4-i]; 

time[j][i]=gDataBuffer[8*j+8-i]; 

} 



timelnt[j]=0; 

maxlnt[j]=0; 

for(i=0;i<4;i++) 

{ 
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timelntyj^imelntyj+HexCharToInKtimeyililj); 

maxInt[j]=maxInt[j]+HexCharToInt(max[j][i] > i); 

} 

} 

for (i=0;i < gNumMax; i++) 

{ 

drawTirne=(tirneInt[i]*(ghorizontalPixels-8UL))/gPeriod; 

SetPort(gWetPaperWind); 

horizontalPosit=drawTime'l'kLeftMargin; 

PenNormal(); 

MoveTo(horizontalPosit,gDataRowStart); 

Line(0,0); 

} 

ScrollDataScanQ; 

timeLong=timeInt[0]; 

retum(timeLong); 

} 

/* */ 



/♦ HexCharToInt */ 

unsigned HexCharToInt(char Bite,int exponent) 

{ 

unsigned value; 



if ((Bite > 47) & (Bite < 58)) 

value=(Bite-48)*Power(kHexBase,exponent); 
if ((Bite > 64) & (Bite < 71)) 

value=(Bite-55)*Power(kHexBase,exponent); 

retum(value); 

} 

/* */ 



/*- 

int 

{ 



■TalkSail */ 

TalkSail(char theChar) 



long 


numCharOut, numCharln, startTime } maxTime; 


OSErr 


serOutErr, serlnErr; 


char 


inBuff[bufferSize],DataBuffer[bufferSize],inChar; 


int 


i, start; 


ScrStaRec 


serialStatusIn, serialStatusOut; 


Str255 


startString; 



numCharOut=lL; 
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serOutErr=FSWrite(gASerRefOut, &numCharOut, &theChar); 
if (serOutErr != noErr) 

{ 

SysBeep(lO); 

DrawString( M \pProbIem sending the character out.”); 
ScrollDisplayO; 

DrawString("\p:"); 

} 

SerStatus(gASerRefOut,&serialStatusOut); 

while ((serialStatusOut.rdPend != 0) || (serialStatusOut.wrPend !=0)) 

{ 

SerStatus(gASerRefOut,&serialStatusOut); 

} 

SerStatus(gASerRefln,&serialStatusIn); 
while(serialStatusIn.rdPend != 0) 

SerStatus(gASerRefIn,&serialStatusIn); 



start=0; 

startTime=TickCountO; 

maxTime=startTime+20L; 



while(l == 1) 

{ 

SerGetBuf(gASerRefIn,&numCharIn); 
serInErr=FSRead(gASerRefIn, &numCharIn, &inBuff); 
if (serlnErr != noErr) 

{ 



SysBeep(lO); 

DrawString("\pProblem receiving characters.”); 
ScrollDisplayO; 

DrawString(”\p:”); 



memmoveC&gDataBufferfstart^&inBuf^numCharln); 

start=start+LoWord(numChar!n); 

if(inBuff[numCharIn-lL] == 03) break; 
if((start < 2) & (TickCountO > maxTime)) break; 

} 

retum(start); 



/* DisplayString V 

void Display String(int numDataPoints) 

{ 

int i; 



for (i=0;i < numDataPoints ;i++) 

{ 
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switch(gDataBuffer[i]) 

{ 

case 03: 

break; 

case 13: 

{ 

if (gDataBuffer[i+l] == 10) 

{ 

ScrollDisplayO; 

i=i+l; 

} 

break; 

} 

case 10: 

{ 

if (gDataBuffer[i+l] == 13) 

{ 

ScrollDisplayO; 

i=i+l; 

} 

break; 

} 

default: 

DrawChar(gDataBuffer[i]); 



/* V 



/* ScrollDisplay */ 

void ScrollDisplay(void) 

{ 

RgnHandle tempRgn; 

WindowPtr window; 

window = FrontWindowQ; 
tempRgn = NewRgnO; 

ScrollRect(&window->portRect, kHorizontalOffset, 

-kRowHeight, tempRgn); 

DisposeRgn(tempRgn); 

MoveTo(kLeftMargin, gRowStart); 

} 

/* ♦/ 



/* ScrollDataScan */ 

void ScrollDataScan(void) 

{ 

RgnHandle tempRgn; 
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WindovvPtr 



window; 



window = Front WindowO; 
tempRgn = NewRgnO; 

ScrollRect(&window->portRect, kHorizontalOffset, 

-kDataScanHeight, tempRgn); 

DisposeRgn(tempRgn); 

MoveTo(kLeftMargin, gDataRovvStart); 

} 

/* */ 



/* ----- DoUpdate - */ 

void DoUpdate(EventRecord *eventPtr) 

{ 

WindovvPtr window; 

window = (WindowPtr)eventPtr->message; 

BeginUpdate(window); 

// put some update info in here 
EndUpdate(window); 

*/ 



} 

/* 



I* Power *1 

int Power(int base, int exponent) 

{ 

int i, p; 

p=i; 

for (i=l;i <= exponent;++i) 
p=p*base; 
retum(p); 

} 

/* */ 





tracker(long numExp) 


int 


b j‘> 


int 


nextlteration, noUpdate=0, numIterations : 


long 


u, index 1, index2; 


double 


f, Cs=1.5; 


double 


theta[kParameters]={0.0, 1000.0,-2500}; 


double 


xvar, yvar, tvar, VfkNumMeas]; 


double 


term; 


double 


stopval=1.0, epsilon=0.1, epsilonc; 



215 



double 

double 

double 

double 

double 

double 

double 

double 

double 

double 

double 

double 

Boolean 

double 

double 

double 

double 

Str255 

long 



D[kParameters][kParameters]; 

Dinv[kParameters][kParameters]; 

dtheta[kParameters]= {0.0,0.0,0.0 } ; 

dthetaSum[kParameters]={0.0,0.0,0.0}; 

Z0=0.0, Zl; 

d1_x, dl_y, d_z, dl; 

d2_x, d2_y, d2; 

g[kNumExp+l], gl [kNumExp+1]; 

dthetaVec; 

xl, x2, yl, y2; 

lamdal , lamda2; 

feasl, feas2, feas3, rhomax; 

nextlter=true; 

*e, *a, *b, *c, *lamda; 

*\vtrue; 

*d\vtrue; 

*wmeas; 

numstr, thetaString; 
thestring; 

maxR=5000.0, maxD=-5000.0, minD=-l .0; 



double 



\vtrue = calloc(3L*(kStep*kNumExp+l),sizeof(double)); 
if(wtrue == NULL) 

{ 

DrawString("\pCan't allocate memory for data collection!!!"); 



wmeas = calloc(3L*(kStep*kNumExp+l),sizeof(double)); 
if(vvmeas == NULL) 

{ 

DrawString("\pCan't allocate memory for data collection!!!"); 
abort(); 

} 

dwtrue = calloc(3L*(kStep*kNumExp+l),sizeof(double)); 
if(dwtrue == NULL) 

{ 

DrawString("\pCan't allocate memory for data collection!!!"); 
abort(); 

} 

e = calloc(kNumExp*kNumMeas,sizeof(double)); 
if (e == NULL) 

{ 

DrawStringC'VpCan't allocate memory for data collection!!!"); 



DrawString("\pCan't allocate memory for data collection!!!"); 



abort(); 



abortO; 



a = calloc(kNumExp*kNumMeas,sizeof(double)); 
if (a == NULL) 
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abortO; 



} 

b = calloc(kNumExp*kParameters,sizeof(double)); 
if (b == NULL) 

{ 

DrawString("\pCan't allocate memory for data collection!!!"); 
abortO; 

} 

c = calloc(kNumExp,sizeof(double)); 
if (c == NULL) 

{ 

DrawString("\pCan't allocate memory for data collection!!!”); 
abortO; 

} 

lamda = caIloc(kNumExp,sizeof(double)); 
if (lamda == NULL) 

{ 

DrawString("\pCan't allocate memory for data collection!!!"); 
abortO; 

} 



f=I.0/sqrt(2.0); 

for(u=0;u<kNumExp;u++) 

{ 

index 1 =3 * (u*kStep+numExp); 
if(indexl >= 3*kStep*(kNumExp+l)) 

index I =index 1 -3 *kStep*(kNumExp+ 1 ); 

index2=3*((u+kNumExp/2)*kStep+numExp); 
if(index2 >= 3*kStep*(kNumExp+l)) 

index2=index2-3*kStep*(kNumExp+l); 



for(i=0;i<3;i++) 

{ 

wtruefkNumMeas^+iJ^gwImdexI+i]; 

wtrue[kNumMeas*u+i+3]=gvv[index2+i]; 

wmeas[kNumMeas*u+i]=gw[indexl+i]; 

wmeas[kNumMeas*u+i+3]=gw[index2+i]; 



while(stopval > epsilon) 

{ 

numIterations++; 

for(i=0;i<kParameters;i++) 

{ 

dthetaSum[i]=0.0; 
for (j=0;j<3;j++) 

D[i]U]=0.0; 



} 

Z0=0.0; 
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for(u=0;u<kNumExp;u++) 

{ 

for(i=0;i<kNumMeas;i++) 

{ 

e[6*u+i]=wtrue[6*u+i]-wrneas[6*u+i]; 

} 

dl_x=(vvtrue[6*u]-theta[0])*(vvtrue[6*u]-theta[0]); 
dl_y=(wtrue[6*u+l]-theta[l])*(wtrue[6*u+l]-theta[l]); 
d_z=theta [ 2 ] * the ta [ 2 J ; 
d 1 =sqrt(d 1 _x+d 1 _y+d_z) ; 

d2_x=(\vtrue[6*u+3]-theta[0])*(vvtrue[6*u+3]*theta[0]); 

d2_y=(\vtrue[6*u+4]-theta[l])*(\vtrue[6*u+4]-theta[l]); 

d2=sqrt(d2_x+d2_y+d_z); 

g[u]=dl-d2-Cs*wtrue[6*u+2]+Cs*wtrue[6*u+5]; 

a[6*u+0] = (\\1rue[6*u+0]-theta[0])/dl; 
a[6*u+l ]= (wtrue[6*u+l ]-theta[ 1 ])/d 1 ; 
a[6*u+2]= -Cs; 

a [6 * u+3 ] = -(wtrue [ 6 * u+3 ] -theta [ 0] )/d2 ; 
a[6*u+4]= -(\vtrue[6*u+4]-theta[l])/d2; 
a[6*u+5] = Cs; 



b[3*u+0]=(\v1rue[6*u+3]-theta[0])/d2-(wtrue[6*u+0]-theta[0])/dl; 
b[3*u+l]=(wtrue[6*u+4]-theta[l])/d2-(\vlrue[6*u+l]-theta[l])/dl; 
b [ 3 * u+2 ] =theta [2]/d 1 -theta [2]/d2; 
for(i=0;i<3;i++) 

if(b[3*u+i] == 0.0) 

b[3*u+i]=le-6; 



c[u]=0.0; 

for(j=0;j<6;j++) 

term=a[6*u+j]*gV[j]*a[6*u+j]; 

e[u]=e[u]+t err n; 



for(i=0;i<3;i++) 

{ 

for(j=0;j<3;j++) 

{ 

D[i][j] = D[i][j]+(l/c[u])*(b[3*u+i]*b[3*u+j]); 

} 

} 

dthetaVec=0.0; 

for(i=0;i<6;i++) 

{ 

dtheta Vec=dtheta Vec+a[6*u+i] *e[6*u+i] ; 

} 
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for(i=0;i<3;i++) 

{ 

dthetaSum[i]=dthetaSum[i]+(dthetaVec-g[u])*b[3*u+i]/c[u]; 

} 

ZO=ZO+g[u]*g[u]/c[u]; 



x 1 =D[ 1 ][ 1 ]-D[0] [ 1 ]*D[ 1 ][0]/D[0][0], 
x2=D[l][2]-D[0][2]*D[l][0]/D[0][0], 
y 1=D[2][1]-D[0][1]*D[2][0]/D[0][0]; 
y 2=D[2][2 ]-D[0][2] *D[2][0]/D[0][0]; 

Dinv[2][2]=xl/(xl*y2-x2*y 1); 

Dinv[l][2]=-x2/(xl*y2-x2*yl); 

Dinv[0][2]=-(D[0][ l]*Dinv[l][2]+D[0][2]*Dinv[2][2])/D[0][0]; 

Dinv[2][ 1 ]=-y l/(x 1 *y2-x2*y 1); 

Dinv[ 1 ][ 1 ]=( 1 .0+x2*y l/(x 1 *y 2-x2*y 1 ))/x 1 ; 
Dinv[0][l]=-(D[0][l]*Dinv[l][l]+D[0][2]*Dinv[2][l])/D[0][0]; 

Dinv[2][0]=(xl/(xl*y2-x2*yl))* 

(-D[2][0]/D[0][0]+(D[ 1 ][0]*y 1 )/(D[0][0]*x 1)); 
Dinv[l][0]=-(D[l][0]/D[0][0]+x2*Dinv[2][0])/xl; 
Dinv[0][0]=(1.0-(D[0][ l]*Dinv[l][0]+D[0][2]*Dinv[2][0]))/D[0][0]; 

for(i=0;i<kParameters;i++) 

{ 

dtheta[i]=0.0; 

for(j=0 ;j <kPara meters; j ++) 

{ 

dtheta [i]=dtheta [i] +Dinv[ i] [j ] * dtheta Sum[j ] ; 

} 

} 

for(u=0;u<kNumExp;u++) 

{ 

lamda 1=0.0; 

for(i=0;i<3;i++) 

{ 

lamda 1 =lamda l+b[3*u+i]*dtheta[i]; 

} 

lamda 2=0.0; 
for(i=0;i<6;i++) 

{ 

Iamda2=lamda2+a[6*u+i]*e[6*u+i]; 

} 

lamda[u]=(lamdal-lamda2+g[u])/c[u]; 

for(i=0;i<6;i++) 

{ 

// term=gV[i]*a[6*u+i]; 
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d\vtrue[6 # u+i]=-e[6*u+i]-lamda[u]*gV[i]*a[6*u+i]; 

} 

} 

if(dtheta[0] >= 0.0) 

feasl=(kMaxR-theta[0])/dtheta[0]; 
if(dtheta[0] < 0.0) 

feasl=(kMaxR+theta[0])/(-dtheta[0]); 

if(dtheta[ 1] >= 0.0) 

feas2=(kMaxR-theta[ 1 ])/dtheta[ 1]; 
if(dtheta[l] < 0.0) 

feas2=(kMaxR+theta[ 1 ])/(-dtheta[ 1 ]); 

if(dtheta[2] >= 0.0) 

feas3=(kMinD-theta[2])/dtheta[2]; 
if(dtheta[2] < 0.0) 

feas3=(kMaxD-theta[2])/dtheta[2]; 

rhomax=1.0; 
if(feasl < rhomax) 

rhomax = feasl; 
if(feas2 < rhomax) 

rhomax = feas2; 
if(feas3 < rhomax) 

rhomax=feas3; 

epsilon=(gtheta[0]+0.001)/le6; 
if(epsilon < 0) 

epsilon=-epsilon; 
epsilonc=(gtheta[ 1 J+0.00 1 )/l e6; 
if(epsilonc < 0) 

epsilonc=-epsilonc; 
if(epsilonc < epsilon) 

epsilon=epsilonc; 
epsilonc=(gtheta[2]+0.00 1 )/l e6; 
if(epsilonc < 0) 

epsilonc=-epsilonc; 
if(epsilonc < epsilon) 

epsilon=epsilonc; 

nextlteration=0; 
vvhile(nextIteration == 0) 

{ 

Z1=0.0; 

for(u=0;u<kNumExp;u++) 

< 

dl_x=(( w lrue[6*u]+rhomax*f*dvvtrue[6*u]) 

-(gtheta[0]+rhomax*f*dtheta[0]))* 
((vvtrue [ 6 * u ] +rho m ax * f* d wtrue [ 6 * u] ) 

-(gtheta[0]+Thomax*f*dtheta[0])); 

dl_y=((vvtrue[6*u+l]+rhomax*f*dvvtrue[6*u+l]) 
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-(gtheta[ 1 ]4rhornax*f*dtheta[ 1 ]))* 
((wtrae[6*u+l]^homax*f*d\vtrue[6*u+l]) 

-(gtheta[ 1 ]+rhomax* f*dtheta[ 1 ])); 

d_z=(gtheta[2]^homax*f*dtheta[2])*(gtheta[2]+rhornax*f*dtheta[2]); 
d 1 =sqrt(d 1 _x+d 1 _y +d_z); 

d2_x=((wtrue[6*u+3]4Thomax*f*dwtnie[6*u+3]) 

-(gtheta[0]4rhornax*f*dtheta[0]))* 

((wtrue[6*u+3]+rhomax*Pdwtrue[6*u+3]) 

-(gtheta[0]+rhornax*f*dtheta[0])); 

d2_y=((v\ r true[6*u+4]+rhomax*f > dwtrue[6*u+4]) 

-(gtheta[ 1 ]4rhornax*f*dtheta[ 1 ]))* 
((wtrae[6*u+4]4rhomax*Pdwtrue[6*u+4]) 

-(gtheta[ 1 ]+rhomax* f*dtheta[ 1 ])); 
d2=sqrt(d2_x+d2_y+d_z); 

g[u]=dl-d2 

<?s*(wtrae[6*u+2]+rhornax*f*dwtrue[6*u+2]) 

+C s * (\vtrue[6 * u+5 ] +rhomax * f* dwtrue [6 * u+5 ] ); 

Zl=Zl+gl[u]*gl[u]/c[u]; 

} 

if(noUpdate > 5) Z 1=0.0; 
if(Zl < Z0) 

{ 

noUpdate=0; 
nextIteration=l ; 
for(i=0;i<3;i++) 

{ 

theta[i]=theta[i]4rhornax*f*dtheta[i]; 

gPosition[i]=gPosition[i]+theta[i]; 

} 

for(u=0;u<kNumExp;u++) 

{ 

for(i=0;i<6;i++) 

\vtrae[6*u+i]=wtrue[6*u+i] 

4rhornax*f*dwtrue[6*u+i]; 

} 

} 

else 

rhomax=rhomax/2.0; 

noUpdate++; 

} 

MoveTo(50,150); 

thestring=theta[0]; 

NumToString(thestring,&nurnstr); 

DrawString(numstr); 

DravvString("\p : "); 
thestring=theta[ 1]; 

NumToString(thestring,&numstr); 
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DrawString(numstr); 

DrawString("\p : ”); 
thestring=theta [ 2] ; 
NumToString(thestring,&numstr); 
DravvString(numstr); 
for(i=0;i<10;i++) ScrollDataScanQ; 



} 



if(numIterations > 50) 
stopval=0.0; 

else 

{ 

if(dtheta[0] < 0) 

stopval=-dtheta[0]; 

else 

stopval=dtheta[0]; 

} 



if(numExp < (TcNumExp+l)*kStep-l) 
gnumExp=gnumExp+l L; 

else 

gnumExp=0L; 



free(wtrue); 

free(vvmeas); 

free(dwtrue); 

free(e); 

free(a); 

free(b); 

free(c); 

free(lamda); 
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